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A  great  deal  of  research  work  has  been  focussed  on  the 
theoretical  and  experimental  studies  of  mechanical 
manipulators  in  recent  years.   Almost  all  of  these  works  are 
related  to  open-loop  serial-link  mechanisms,  but  only  a  few 
have  dealt  with  multi-degree-of-f reedom  parallel 
manipulators  such  as  the  Stewart  platform  or  similar 
mechanisms . 

A  new  type  of  two-degree-of -freedom  Rotary-Linear  (R-L) 
actuator  was  adapted  in  this  work.   Several  possible 
configurations  of  parallel  six-degree-of-f reedom 
manipulators  with  ground-mounted  actuators  have  been 
synthesized.   With  parallel  configuration  of  the 
manipulators,  the  computations  can  be  performed 
simultaneously.   Therefore,  the  computation  time  will  be 
significantly  reduced. 


Workspace  analysis  of  a  six-degree-of -freedom  parallel 
manipulator  has  been  presented  by  determining  the  shapes  and 
boundaries  of  the  subworkspace  and  root  regions  in  the 
subworkspace.   The  workspace  of  the  manipulator  is  obtained 
as  the  common  reachable  region  of  the  subworkspaces 
determined  by  the  corresponding  subchains.   The  orientation 
and  the  rotatability  of  the  platform  are  also  investigated. 

Finally,  mechanical  error  analysis  of  the  manipulator, 
due  to  the  minor  inaccuracies  in  displacements  of  the 
actuators,  is  studied  by  using  the  theory  of  screws. 


CHAPTER  1 
INTRODUCTION 


1 . 1   Literature  Overview 

Robotics  has  been  a  very  popular  subject  to  study  in 
the  last  few  years.   Researchers  have  developed  many 
advanced  concepts  and  theories  in  kinematics,  dynamics, 
controls,  actuators  and  sensors  for  the  design  of  robots. 
Recent  areas  of  study  also  involve  workspace,  obstacle 
avoidance,  full  rotational  dexterity  of  the  end-effector 
and  the  control  of  flexible  manipulator  systems  recently. 
With  the  development  of  microprocessors,  which  has  played 
an  important  role  in  the  rapid  growth  of  industrial  robots, 
multi-degree-of-freedom  mechanical  systems  are  now  becoming 
a  practical  choice  for  use  in  automatic  machinery.   It  has 
been  well  recognized  that,  by  using  multi-degree-of-freedom 
robotic  manipulators  with  multiple  actuators  and  automatic 
control  systems,  we  can  achieve  the  goal  of  improving 
efficiency,  accuracy,  reliability  and  reducing  energy 
consumptions  and  cost  of  production  in  flexible 
manufacturing  systems. 

Robotic  manipulators  currently  in  use  in  industry  and 
studied  for  research  purposes  are  almost  all  traditional 
open-loop  serial-link  manipulators  in  which  the  number  of 
degrees  of  freedom  of  the  end-effector  is  equal  to  the  sum 
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of  the  relative  degrees-of-f reedom  of  the  joints  in  the 
chain.   There  are  only  a  small  number  of  multi-degree-of- 
freedom  designs  which  involve  multi-loop  manipulator 
linkages,  with  totally  parallel  or  partially  parallel 
configurations.   Since  the  design  techniques  for  multi-loop 
robotic  manipulators  are  still  in  the  infancy  of  their 
development,  investigating  and  developing  the  theoretical 
background  for  multi-degree-of-f reedom  multi-loop  robotic 
manipulators  may  have  a  significant  impact  in  the  near 
future  in  manufacturing  industry. 

For  a  given  set  of  manipulator  linkage  dimensions,  it 
is  necessary  to  determine  all  admissible  positions  of  the 
end  effector.   The  collection  of  all  such  possible  positions 
is  called  the  workspace  of  the  manipulator.   Recently 
several  methods  have  been  proposed  to  determine  the 
workspace  of  a  manipulator  by  showing  possible  extreme 
positions  of  the  end  effector.   These  methods  let  us 
calculate  directly  the  boundaries  of  the  workspace  of  a 
given  point  or  line  on  the  hand. 

Workspace  analysis,  generally,  refers  to  determining 
the  boundaries  of  the  workspace.   Workspace  synthesis,  on 
the  other  hand,  consists  of  determining  dimensions  of  the 
manipulator  linkage  and  ranges  of  joint  motions  for  a 
specified  workspace. 

One  of  the  primary  functions  of  the  manipulator  is  to 
have  its  end-effector  reach  a  set  of  points  in  space  with 
prescribed  positions  and  orientations.   The  manipulators 


3 
investigated  early  were  almost  all  serial  kinematic  chains, 
since  these  manipulators  usually  have  larger  workspaces  and 
more  dexterous  maneuverability  than  those  of  parallel 
kinematic  chains.   However,  serial  chains  have  poor 
stiffness  and  undesirable  dynamic  characteristics  in  high- 
speed operation.   Also,  it  is  usually  difficult  to  solve 
their  inverse  kinematics  problem.   Therefore,  mechanisms 
based  on  parallel  kinematic  chains  may  have  certain 
advantages  when  dynamic  loading  is  present  and  only  limited 
workspace  is  required. 

Serial  multi-degree-of-f reedom  manipulators  have  been 
extensively  investigated.   Roth  [1]  studied  the  relationship 
between  the  kinematic  parameters  of  a  manipulator  and  its 
workspace.   Shimano  and  Roth  [2]  presented  the  analytical 
and  geometrical  conditions  for  a  line  on  the  hand  to  be  at 
the  farthest  distance  from  the  base  revolute  pair.   Sugimoto 
and  Duffy  [3,  4]  developed  an  algorithm  to  determine  the 
extreme  distances  of  a  robot  hand.   Kumar  and  Waldron  [5] 
developed  the  theory  and  algorithm  for  tracing  the  bounding 
surfaces  of  a  manipulator  workspace.   Sugimoto  and  Duffy  [6] 
and  Sugimoto,  Duffy  and  Hunt  [7]  investigated  the 
singularities  in  the  workspace.   Kumar  and  Waldron  [8] 
presented  the  algorithm  for  tracing  the  bounding  surfaces  of 
manipulator  workspaces.   Tsai  and  Soni  [9]  presented  the 
study  of  determining  the  accessible  region  for  two  and 
three-link  robotic  arms  with  pin- joints.   Gupta  and  Roth 
[10]  presented  some  basic  concepts  regarding  the  workspace 
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shapes  and  structures  of  manipulators.   Self ridge  [11] 
presented  an  algorithm  for  finding  the  boundary  of  reachable 
volume  of  an  arbitrary  revolute- joint ,  serial-link 
manipulator.   Tsai  and  Soni  [12]  developed  an  algorithm  for 
the  workspace  of  a  general  n  R  robot  based  on  a  linear 
optimization  technique  and  on  small  incremental 
displacements  applied  to  coordinate  transformation  equations 
relating  the  kinematic  parameters  on  the  n  R  robot.   Yang 
and  Lee  [13]  derived  the  equations  representing  the 
boundaries  of  the  workspace.   Existence  of  holes  and  voids 
in  the  workspace  were  also  investigated.   Lee  and  Yang  [14] 
have  made  a  study  of  outlining  the  boundary  of  the 
workspace,  the  quantitative  evaluation  of  the  volume,  and 
introduced  a  manipulator  performance  index.   Hansen,  Gupta 
and  Kazerounian  [15]  used  a  stable  iterative  algorithm  for 
inverse  kinematic  analysis  to  determine  the  approach  angles 
and  lengths  for  reaching  points  in  the  workspace. 
Freudenstein  and  Primrose  [16]  described  the  workspace  of  a 
three-axis,  turning-pair-connected  robot  arm  of  general 
proportions  in  terms  of  the  volume  swept  cut  by  the  surface 
of  a  skew  torus  rotating  about  an  offset  axis  in  space. 
Kohli  and  Spanos  [17]  studied  the  workspace  analysis  of 
mechanical  manipulators  by  using  polynomial  displacement 
equations  and  their  discriminants.   Spanos  and  Kohli  [18] 
performed  the  study  of  workspace  analysis  of  a  class  of 
manipulators  having  the  last  three  revolute  joint  axes 
intersect  orthogonally  at  a  point.   Cwiakala  and  Lee  [19] 


used  an  optimization  technique  to  outline  the  boundary 
profile  of  a  manipulator  workspace  and  perform  quantitative 
evaluation  of  the  workspace  volume.   Tsai  and  Soni  [20] 
illustrated  the  general  procedures  to  synthesize  the 
workspace  of  3R,  4R,  5R  and  6R  robots.   Tsai  and  Soni  [21] 
also  considered  the  effects  of  kinematic  parameters  on  the 
workspace  of  general  3R  robots.   Oblak  and  Kohli  [22]  used 
an  analytical  method,  based  on  displacement  equations,  to 
identify  the  Jacobian  surface  or  a  D-shaped  surface  which 
the  workspace  of  a  regional  structure  is  bounded  by. 
Davidson  and  Hunt  [23]  had  a  study  of  the  rigid  body 
location  and  robot  workspaces  by  using  an  enumeration 
procedure.   Davidson  and  Hunt  [24]  described  plane 
workspaces  for  robots  by  using  a  sweeping  process  and  the 
necessary  equations  for  computer  generation  of  plane- 
workspace  envelops  and  boundaries.   Davidson  and  Pingail 
[25]  continued  to  generate  envelope-surfaces  for  plane- 
workspace  of  generally  proportioned  manipulators.   Chen  [26, 
27]  presented  an  analytical  method  for  workspace  analysis  of 
robot  arms  by  using  differential  geometry.   Kohli  and  Hsu 
[28]  studied  the  Jacobian  analysis  of  workspaces  of 
mechanical  manipulators  by  determining  the  maximum  reach  of 
the  manipulator  within  the  intersection  of  the  boundary  with 
a  specified  plane.   Hsu  and  Kohli  [29]  dealt  with  closed- 
form  workspace  analysis  and  used  the  Jacobian  surfaces  to 
separate  inaccessible  regions,  two-  and  four-way  accessible 
regions  in  both  manipulator  coordinates  and  Cartesian 
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coordinates.   Palmquist  [30]  studied  the  reachable  workspace 
common  to  two  planar  RRR  robots,  dexterous  relationship 
between  them  and  the  kinematic  motion  capabilities  of  them. 

There  are  few  works  that  have  dealt  with  parallel 
multi-degree-of -freedom  manipulators.   The  Stewart  platform 
[31]  is  a  kind  of  parallel  manipulator  which  has  two  plates 
connected  by  six  adjustable  legs  and  is  a  six-degree-of- 
freedom  mechanism.   It  was  originally  used  for  flight 
simulators  and  was  suggested  for  applications  on  machine 
tools  and  on  space  vehicle  simulators.   Asada  and  Ro  [32] 
applied  a  direct-drive  arm  to  a  closed-loop  five-link 
mechanism  to  overcome  the  problems  encountered  in  open-loop 
arrangements.   Trevelyan,  Kovesi  and  Ong  [33]  applied  such  a 
mechanism  to  a  sheep  shearing  robot.   Bajpai  and  Roth  [34] 
studied  the  workspace  and  mobility  of  such  a  closed-loop 
planar  five-link  mechanism.   Yang  and  Lee  [35]  presented  a 
feasibility  study  of  the  Stewart  platform  as  a  robot 
manipulator.   The  extreme  ranges  of  motion,  rotatability 
and  workspace  were  investigated  and  the  workspace  and  the 
maneuverability  were  found  to  be  relatively  restricted. 
Fichter  [36]  also  studied  Stewart  platform-based 
manipulators,  theoretical  aspects  of  the  generalized  Stewart 
platform,  and  practical  considerations  for  building  a 
working  machine.   Again,  Cwiakala  [37]  used  the  optimum 
path  search  technique  to  find  the  section  of  the  workspace 
of  the  Stewart  platform  mechanism.   Recently,  Kohli,  Lee, 
Tsai  and  Sandor  [38]  investigated  manipulator  configurations 
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with  ground-mounted  rotary-linear  actuators;  their  direct 
and  inverse  kinematics  were  also  derived. 

The  majority  of  current  industrial  robots  are  used  for 
body  guidance.   One  of  the  criteria  in  the  control  steps  is 
to  reduce  the  positioning  error  to  a  limited  range.   The 
techniques  needed  to  solve  such  problems  have  been  developed 
in  the  study  of  closed-loop  spatial  linkages.   Hartenberg 
and  Denavit  [39]  used  a  deterministic  method  to  analyze  the 
mechanical  error.   Garrett  and  Hall  [40]  used  a  statistical 
approach  for  mechanical  error  analysis.   Dhande  and 
Chakraborty  [41]  presented  a  stochastic  model  of  the  planar 
four-bar  function  generating  linkage  mechanism  for  error 
analysis  and  synthesis  for  specified  maximum  of  mechanical 
error.   Chakraborty  [42]  presented  a  probabilistic  model  of 
linkage  mechanisms  considering  tolerances  on  the  link 
lengths  and  clearances  in  the  hinges,  which  may  cause 
mechanical  error.   Dhande  and  Chakraborty  [43]  studied  the 
effect  of  random  error  in  the  joint  of  spatial  linkages  and 
developed  a  synthesis  procedure  to  allocate  tolerances  and 
clearances  on  different  members  of  linkages  to  restrict  the 
output  error  within  specified  limits. 

1.2  Serial  and  Parallel  Manipulators 
Open-loop  serial-link  manipulators  have  been  the 
subject  of  numerous  investigations  and  have  found 
considerable  applications  in  industry.   In  recent  years, 
there  has  been  considerable  increase  in  research  in  the 
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area  of  robotics  and  multi-degree-of -freedom  programmable 
automation  devices.   For  being  competitive  in  international 
markets,  the  use  of  flexible  manufacturing  systems  in 
industries  is  becoming  more  and  more  important. 

The  heart  of  the  flexible  manufacturing  system  consists 
of  computer  controlled  multi-degree-of -freedom  devices  such 
as  robots  and  N.C.  machines.   The  configurations  which  have 
been  widely  used  for  these  machines  are  serial-link  (open- 
chain  type)  arrangements,  where  one  link  is  connected  to 
adjacent  links  by  single-degree-of -freedom  joints,  each  with 
its  separate  actuator.   Similarly,  although  N.C.  machines 
are  also  serial-link  devices,  the  several  degrees  of  freedom 
are  distributed  between  the  work  piece  and  the  tool,  which 
decouples  the  motions  associated  with  various  groups  of 
several  degrees  of  freedom.   This  simplifies  kinematic, 
dynamic,  and  control  computations.   The  manipulator 
mechanism  generally  consists  of  six  links  serially  connected 
via  six  single-degree-of-f reedom  separately  actuated 
revolute  or  prismatic  joints.   The  end  effector,  which  is 
attached  to  the  most  distal  link,  imparts  motion  of  six 
degrees  of  freedom  to  the  work  piece.   The  motion  and/or 
force  associated  with  these  six  degrees  of  freedom  may  be 
controlled. 

Although  the  mechanism  may  appear  simple,  the  motion  of 
the  end  effector  is  related  to  joint  motions  by  mathematical 
transformations  which  are  generally  not  easy  to  visualize. 
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Duffy  [44]  developed  the  theory  which  is  applied  to 
the  analysis  of  single-loop  mechanisms,  which  are  movable 
polygons  or  open  chains  with  one  end  fixed  to  the  ground, 
closed  by  an  imaginary  link  between  ground  and  a  free  end 
where  there  is  a  mechanical  hand  or  gripping  device. 

Hunt  [45]  has  discussed  all  possible  single-  and  multi- 
degree-of-freedom  kinematic  pairs  and  used  screw  theory, 
kinematic  geometry  and  the  techniques  of  linear  algebra  to 
systematize  in-parallel-actuated  robot-arms.   Mohamed  and 
Duffy  [46]  also  applied  screw  theory  to  study  the 
instantaneous  kinematics  of  the  end-effector  platform  of 
fully  parallel  robot-type  device.   Sugimoto  [47]  derived  the 
kinematic  and  dynamic  model  for  a  parallel  manipulator  by 
using  motor  algebra  and  Newton-Euler  formulation. 

A  comparison  between  the  serial  and  parallel  devices 
in  terms  of  some  necessary  and  desirable  performance  and 
control  characteristics  was  presented  by  Cox  [48].   There 
are  eight  performance  characteristics  chosen  as  follows: 

i.  Range  of  motion 

ii.  Rigidity  or  stiffness  and  strength 

ill.  Complexity  of  end-effector  positioning 

formulation  (computability) 

iv.  Complexity  of  system  dynamics  (computability) 

V.  Precision  positioning 

vi.  Load  carrying  distribution  through  system 

vii.  Fabrication  (economics) 

viii.  Compactness 
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Hunt  [45,  49]  also  showed  some  possible  alternative  designs 
for  manipulators  using  parallel  kinematic  chains,  and 
pointed  out  that  there  are  many  intermediate  possibilities 
between  purely  serial  and  purely  parallel  kinematic 
structures. 

It  is  well  recognized  that  more  investigations  in  the 
study  of  parallel  manipulators  are  needed  and  they  may  have 
potential  usefulness  in  the  manufacturing  industry. 

1. 3   Summary 
Conventional  serial-linkage  manipulators  have  each  of 
their  up-to  6  actuators  mounted  on  the  joint  they  actuate. 
This  means  that  the  mass  of  these  actuators  is  added  to  the 
link  masses,  which  greatly  increases  the  inertia  seen  by 
actuators  and  links  closer  to  the  ground. 

On  the  other  hand,  multi-loop  manipulators  with  ground - 
mounted  actuators  need  to  consider  only  the  masses  of  the 
links  themselves.   Also,  the  links  can  be  lighter  for  the 
same  payload. 

In  Table  1.1,  a  comparison  between  serial  and  parallel 
kinematic  chains  is  shown,  where  X  means  more  favorable 
performance. 

The  successful  completion  of  the  study  of  parallel 
manipulators  would  open  up  a  new  direction  in  the  design  of 
robotic  manipulators  with  advantages  over  present  practice, 
such  as  improved  payload  capacities,  increased  positioning 
accuracy,  greater  economy  in  energy  consumption,  better 
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dynamic  performance,  increased  speed  with  improved 
precision,  and  reduced  first  cost. 


Table  1 , 1   Performance  characteristic  between  serial 
and  parallel  kinematic  chains 


Performance 
characteristic 

Serial 
structure 

Parallel 
structure 

Compactness 

X 

Computation  time 

Y^ 

Dexterous  maneuverability 

X 

Direct  kinematics 

X 

Inertia 

X 

Inverse  kinematics 

X 

Payload  capacity 

X 

Power/weight 

X 

Precision  positioning 

X 

Stiffness 

X 

Workspace 

X 

CHAPTER  2 

TYPE  SYNTHESIS  AND  INVERSE  KINEMATICS 

OF  THE  MANIPULATORS 


2. 1   Introduction 

Industrial  robots  are  available  in  a  wide  variety  of 
shapes,  sizes  and  physical  configurations.   Generally,  the 
first  three  degrees  of  freedom  (links)  of  the  majority  of 
today's  available  robots  are  primarily  used  to  achieve  a 
desired  position  for  the  origin  of  the  wrist.   These  differ 
considerably  from  one  another  and  can  be  classified  as 
cartesian,  cylindrical,  spherical  and  revolute  which  are 
shown  in  Fig.  2.1.   The  remaining  degrees  of  freedom  are 
subsequently  employed  to  achieve  desired  tool  frame 
orientations.   For  this  purpose,  almost  all  arrangements  use 
revolute  pairs  with  their  axes  intersecting  at  a  point.   For 
such  geometries,  the  position  of  the  common  point  of 
intersection  (wrist  center)  depends  only  on  the  first  three 
joint  variables  of  the  structure.   Once  these  are  computed, 
the  orientation  of  the  hand  can  be  attained  by  rotating  the 
last  three  joints  only.   However,  the  number  of  links  can 
be  reduced  by  using  joints  with  larger  degrees  of  freedom 
such  as  cylindric  and  spherical  pairs. 

A  novel  geometry  of  a  ground-mounted  two-degree-of - 
freedom  self -actuated  joint  connecting  a  manipulator  link  to 
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Figure  2.1   Four  basic  manipulator  configurations 
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the  ground  is  presented  by  Kohli,  Lee,  Tsai  and  Sandor  [38]. 
It  combines  a  rotary  actuator  and  a  linear  actuator  in  such 
a  way  that  it  imparts  cylindrical  ( two-degree-of -freedom, 
combined  rotational  and  translational)  relative  motion  to 
the  manipulator  link  with  respect  to  ground.   The  rotary  and 
the  linear  actuators  are  independent  of  each  other  and  do 
not  "see"  each  other's  inertias.   Based  on  this  new 
arrangement,  several  possible  manipulator  linkage 
configurations  with  six  degrees  of  freedom  are  described  in 
this  chapter. 

2. 2  R-L  (Rotary-Linear)  Actuator 
Two  different  configurations  of  R-L  actuators  are 
shown  in  Figs.  2.2  and  2.3.   In  Fig.  2.2,  C  is  a  splined 
shaft,  and  link  E  is  mounted  on  the  shaft  and  contains 
internal  splines  in  its  hub.   Therefore,  link  E  can  be 
translated  on  shaft  C  and  be  rotated  when  shaft  C  rotates. 
A  is  a  linear  actuator  and  is  connected  to  bracket  B  which 
is  not  splined  and  can  freely  slide  on  shaft  C  and  makes  the 
link  E  slide  on  shaft  C.   The  rotary  actuator  D  rotates  the 
shaft  C.   The  rotary  and  linear  actuators  thus  rotate  and 
translate  link  E  on  shaft  C  without  seeing  each  others' 
inertia.   The  motion  of  link  E  is  the  same  as  that  provided 
by  a  cylinder  pair  with  an  axis  which  is  the  same  as  that  of 
shaft  C.   In  such  configuration,  link  E  cannot  rotate  by  360 
degrees  due  to  interference  between  link  E  and  bracket  B. 
In  Fig.  2.3,  the  linear  actuator  is  connected  to  link  E 
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Rotary  Actuator 


Splined  Shaft 


Linear  Actuator 


Fiaure    2.2      (R-L)    actuator 
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Figure    2.3      (R-L)    actuator  with    360°    rotatability 


17 
through  grooved  hub  B  by  means  of  pins  or  split  ring  P.   In 
this  configuration  link  E  can  rotate  a  full  360  degrees. 

The  R-L  actuator  controls  a  rotation  around  and  a 
translation  along  the  axis  of  a  cylinder  pair  and  is  used 
in  type  synthesis  of  parallel  manipulators.   The  principal 
advantages  of  using  this  type  of  actuator  in  the  structure 
of  parallel  manipulators  are  that,  first,  R-L  actuators  can 
all  be  mounted  on  the  ground.   This  reduces  the  necessary 
load  capacities  of  the  joints  which  need  support  only  the 
mechanism  links  and  the  payload,  whereas  serial  open-loop 
robot  manipulators  must  have  joints  that  carry  not  only  the 
links  and  the  payload,  but  also  the  actuators,  their 
controls  and  power  conduits  of  all  subsequent  joints. 
Secondly,  with  all  three  R-L  actuators  mounted  on  the 
ground,  the  computations  required  for  inverse  kinematics  and 
thus  the  Jacobian  matrix  are  significantly  simplified. 

In  a  manipulator  configuration  where  all  the  actuators 
could  be  mounted  on  the  ground,  the  rotary  and  linear 
actuators  that  form  the  R-L  actuator  could  be  off-the-shelf 
items,  since  the  power  to  weight  ratio  is  not  a  major 
concern  in  this  situation.   Thus  the  cost  of  the  R-L 
actuators  can  be  considerably  less  than  the  actuators 
currently  being  designed  especially  for  and  used  in  serial 
link  manipulators. 
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2. 3   Type  Synthesis 
The  earliest  study  of  parallel  manipulators  is  that  of 
Stewart's  platform,  as  shown  in  Fig.  2.4,  which  has  six 
degrees  of  freedom.   The  actuators  are  mounted  on  the 
floating  links.   Hunt  [45]  shows  a  three-degree-of -freedom 
and  a  six-degree-of -freedom  parallel  manipulator,  as  shown 
in  Figs.  2.5  and  2.6  respectively,  whose  actuators  are 
mounted  on  the  floating  links  and  on  the  ground, 
respectively.   However,  Hunt's  six-degree-of -freedom 
manipulator,  as  shown  in  Fig.  2.6,  has  additional  six 
redundant  degrees  of  freedom:  the  axial  rotation  of  the  six 
S-S  links  which  causes  uncontrolled  wear  in  the  S  joints. 
By  using  ground-mounted  R-L  actuators,  we  can  reduce  the 
number  of  links  of  the  mechanisms  and  still  have  six  degrees 
of  freedom  of  the  end  effector,  without  any  redundant 
degrees  of  freedom  in  the  mechanism. 

With  the  R-L  actuator  ground-mounted,  we  can  have 
several  possible  configurations  for  each  subchain  of  the 
parallel  manipulators  with  six  degrees  of  freedom.   These 
configurations  are  as  follows: 

Dyads      (R-L)-S-R       (R-L)-R-S       (R-L)-P-S 
(R-L)-S-P       (R-L)-C-C 

Triads     (R-L)-R-R-C  (R-L)-C-R-R  (R-L)-R-C-R 

(R-L)-R-P-C  (R-L)-R-C-P  (R-L)-P-R-C 

(R-L)-P-C-R  (R-L)-C-R-P  (R-L)-C-P-R 

(R-L)-P-P-C  (R-L)-P-C-P  (R-L)-C-P-P 
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Figure  2.4   Stewart  platform  mechanism 


20 


Figure  2 . 5 


Parallel  platform-type  manipulator  with  three 
degrees  of  freedom 
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Figure  2.6   Parallel  platform- type  manipulator  with  six 
degrees  of  freedom 
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These  chains  are  shown  in  Figs.  2.7  and  2.8,  where  the  order 
of  (R-L)  can  be  reversed  as  (L-R). 

2  .  4   Technical  Discussion 

Actuator.   One  of  the  major  concerns  in  the  design  of 
serial  open-loop  manipulators  is  to  maximize  the  actuator 
power/weight  ratio,  since  some  of  the  actuators  must  be 
mounted  on  the  moving  links,  as  shown  in  Fig.  2.9,  which 
adds  to  the  inertia  of  the  actuators  to  the  links'  inertia 
and  decreases  payload  capacity-   Therefore,  the  actuator 
size  increases  from  the  distal  joint  to  the  proximal  joint. 
The  manipulator  becomes  a  massive  linkage  requiring  bigger 
actuator  sizes  and  resulting  in  smaller  payloads.   If  one- 
degree-of -freedom  actuators  are  to  be  used,  this  will 
result  in  a  five-loop  linkage  for  a  six-degree-of-f reedom 
robot  manipulator.   Further,  if  only  one-degree-of -freedom 
joints  are  used,  the  number  of  links  in  the  linkage  becomes 
quite  large.   The  number  of  links  can,  however,  be  reduced 
by  using  joints  with  more  than  one  degree  of  freedom,  such 
as  cylinder  and  spherical  pairs.   The  number  of  loops  can 
also  be  reduced,  thereby  reducing  the  number  of  links 
further  by  devising  and  using  two-  or  more-degree-of- 
f reedom  self-actuated  joints.   A  six-degree-of-f reedom 
parallel  manipulator,  where  all  actuators  are  ground- 
mounted,  is  shown  in  Fig.  2.10. 

Computation.   The  computation  of  inverse  kinematics  and 
dynamics  requires  considerable  time  for  serial-link 
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Figure  2.7   Possible  configurations  of  dyads  with  six 
degrees  of  freedom 
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Figure  2.9   Actuators  in  a  serial  manipulator 
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Figure  2.10   Actuators  in  a  parallel  manipulator 


28 
manipulators.   Generally,  computations  of  one  link  depend 
upon  other  links.   These  computations  must  be  done 
serially,  thus  making  parallel  processing  difficult  and 
ineffective  in  reducing  computation  time.   With  parallel- 
type  configuration  in  the  manipulators,  the  computation  can 
be  performed  in  parallel.   Therefore,  the  computation  time 
will  be  significantly  reduced.   In  general,  the  computations 
required  for  inverse  kinematics  and  Jacobian  matrices  will 
be  less  complicated  than  those  of  serial  open-loop 
manipulators,  but  the  computations  for  direct  kinematics  are 
much  involved. 

Based  on  this  new  possibility,  we  describe  possible 
manipulator  configuration  linkages  with  six  degrees  of 
freedom.   Then  we  identify  possible  configurations  in  which 
all  actuators  for  actuating  the  manipulator  linkage  are 
ground-mounted.   The  distinct  advantage  of  being  able  to 
put  many  actuators  on  the  ground  makes  these  manipulator 
topologies  appealing. 

Degrees  of  freedom.   In  general,  the  mobility  of  a 
kinematic  chain  can  be  obtained  from  the  Kutzbach  criterion. 
The  six-dimensional  form  of  the  criterion  is  given  as 

m  =  6(n  -  1)  -  5Ji  -  4J2  -  3J3  -  2J4  -  J5         (2.1) 

where  m   =  mobility  of  mechanism, 
n   =  number  of  links, 
jj_  =  number  of  joints  having  i  degrees  of  freedom. 
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Freudenstein  and  Maki  [50]  also  show  that  a  general 
form  of  the  degree-of-f reedom  equation  for  both  planar  and 
spatial  mechanisms  can  be  written  as 


F  =  d(n  -  j  -  1)  +  Sfj_  -  T(^  (2.2) 

i 


where  F   =  the  effective  degree  of  freedom  of  the  assembly 
or  mechanism, 

d   =  the  degree  of  freedom  of  the  space  in  which  the 

mechanism  operates  (for  spatial  motion  d  =  6,  and 
for  planar  motion  and  motion  on  a  surface  d  =  3), 

n   =  number  of  links, 

j   =  number  of  joints, 

fj_  =  degree  of  freedom  of  i-th  joint, 

1(^  =   idle  or  passive  degrees  of  freedom. 

The  number  of  degrees  of  freedom  that  a  manipulator 
possesses  is  the  number  of  independent  position  variables 
which  would  have  to  be  specified  in  order  to  locate  all 
parts  of  the  mechanism.   In  the  case  of  serial  manipulators, 
each  joint  displacement  is  usually  defined  with  a  single 
variable;  the  number  of  joints  equals  the  number  of  degrees 
of  freedom. 

The  number  of  degrees  of  freedom  of  multi-loop 
manipulator  linkages  containing  multi-degree-of -freedom 
self-actuated  joints  can  be  determined  simply  by  the 
following  equation: 
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n 
F^  =  E  Fi  -  6(n  -  1)  <2.3) 

^      i=l 


where  F^,  =  the  number  of  degrees  of  freedom  of  the  multi- 
loop mechanism, 
Fi  =  the  number  of  degrees  of  freedom  of  the  i-th 

subchain  ( leg) , 
n  =  the  number  of  subchains  (legs) 

As  shown  in  Fig.  2.10,  there  are  three  identical 
subchains  and  each  subchain  has  six  degrees  of  freedom. 
Therefore,  the  number  of  degrees  of  freedom  of  this  type  of 
parallel  manipulator  can  be  calculated  from  Eq.  (2.3)  as 

F^=  (6+6+6)  -6(3-1)  =6 


2. 5   Inverse  Kinematics 
When  the  position  of  one  link,  generally  the  hand,  is 
specified  and  it  is  required  to  determine  the  position  of 
all  other  links,  including  the  joint  variables  of  actuated 
joints  which  will  move  the  hand  to  the  specified  position, 
the  method  is  called  inverse  kinematics.   The  determination 
of  the  actuated  joint  variables  for  a  specified  position  of 
the  hand  is  conducted  by  obtaining  a  set  of  equations 
relating  the  actuated  joint  variables  and  constant 
parameters  of  the  manipulator  linkages  to  the  hand  position 
variables.   In  general,  this  set  of  equations  is  also 
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reduced  to  one  equation  of  polynomial  form  in  only  one  joint 
variable.   For  a  specified  hand  position,  one  proceeds  to 
find  the  roots  of  this  displacement  polynomial  to  determine 
the  joint  variable.   The  degree  of  this  polynomial  also 
determines  the  number  of  possible  ways  the  desired  hand 
position  can  be  reached. 

Generally,  the  methods  employed  in  solving  the  inverse 
kinematics  in  robotics  are  either  analytical  or  numerical. 
An  analytical  solution  is  one  that  produces  a  particular 
mathematical  equation  or  formula  for  each  joint  variable 
(rotation  or  translation)  in  terms  of  known  configuration 
values  (length  of  the  link,  twist  angle  and  offset),  whereas 
a  numerical  solution  generally  pertains  to  the  determination 
of  appropriate  joint  displacements  as  the  result  of  an 
iterative  computational  procedure.   It  is  noted  that  the 
equations  associated  with  the  inverse  kinematic  problem  are 
nonlinear  and  coupled,  and  this  nonlinear  dependence  is 
basically  trigonometric. 

As  shown  in  Figs.  2.7  and  2.8,  there  are  five  possible 
dyads  with  six  degrees  of  freedom  and  twelve  possible  triads 
with  six  degrees  of  freedom.   In  order  to  reduce  the  number 
of  links  in  forming  the  mechanism  and  avoid  the  number  of 
translational  joints  greater  than  three  in  a  loop,  we  only 
consider  subchains  (R-L)-R-S,  (R-L)-P-S,  (R-L)-S-R  and  ( R- 
L)-S-P  as  shown  in  Fig.  2.7  in  the  following  sections. 
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2.5.1   Subchain  (R-L)-R-S 

A  schematic  diagram  of  subchain  (R-L)-R-S  is  shown  in 
Fig.  2.11.   Since  the  position  and  orientation  of  the  hand, 
which  is  embedded  in  the  platform,  is  known,  we  can  find  the 
position  and  orientation  of  the  coordinate  system  0x37323 
embedded  in  the  sphere  at  point  C  with  respect  to  the  local 
fixed  coordinate  system  oxgYoZo  through  systems  HX4y4Z4  and 
OXYZ  by  coordinate  transformations.   Also,  we  can  write  the 
following  equation  to  describe  the  position  of  point  C  with 
respect  to  the  local  fixed  coordinate  system  oxgyoZQ  through 
systems  BX2y2Z2  ^^d  AX2_y]_Z]_  as  follows: 


CO 


.1A2C 


(2.4) 
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(continued) 
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Figure    2.11      Subchain    (R-L)-R-S 
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ce^lbceb   +   a)    -    SBalbSe^Cab    -    s^Sa^) 
se^lbCSb   +    a)    +   CGalbSBi^Cab    -    s^Sa^) 

1 

(2.5)" 
where  the  vector  C°  or  its  components  Cg  (k=  x,  y  and  z) 
denote  the  coordinates  of  point  C  with  respect  to  the  local 
fixed  coordinate  system  oxoyoZQ?  the  vector  C^  denotes  the 
location  of  point  C  with  respect  to  the  coordinate  system 
CX3y3Z3;  9^  and  8^  are  the  rotation  angles  from  Xq  to  x^  and 
from  X2  to  X3 ,  respectively;  d^  is  the  translation  of 
cylindric  joint  A  along  the  fixed  axis  z^   form  the  origin  of 
the  local  fixed  coordinate  system  oxgyoZQ'  ^  ^^^  ^  ^^^  ^^^ 
perpendicular  distance  between  successive  joint  axes  z^,  Z2 
and  Z3,  respectively;  sj-,  is  the  offset  along  the  Z2  axis;  aj^ 
is  the  twist  angle  between  the  axes  Z]_  and  Z2,  and  Aj_ ,  i  =  1 
and  2,  represent  the  Hartenberg  and  Denavit  [39]  4  x  4 
homogeneous  transformation  matrices  which  relate  the 
kinematic  properties  of  link  i  to  link  i-1  and  can  be 
derived  as 


A^ 


C0j 

S9j 
0 
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•SBiCai 


se^Sai    aj_C8j_ 
-C©iSaj_    a^^se^ 
Ca^       di 


(2.6) 


*  C°  can  also  be  obtained  by  using  the  method  in  [44], 
which  is  presented  in  Appendix  A.l. 
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where  C0  and  S9  are  shorthand  for  cos(0)  and  sinO), 
respectively.   Similarly,  Q^   denotes  the  relative  rotation 
angle  of  joint  C,  dj^  and  d^-.  denote  the  translations  of 
joints  B  and  C  along  the  moving  axes  Z2  and  Z3, 
respectively,   and  c  denotes  the  length  of  link  c.   It  is 
noted  that  d-^,    d^   and  c  are  zero  for  this  subchain,  but  all 
these  notations  are  used  throughout  the  following  sections. 

Premultiplying  both  sides  of  Eq.  (2.4)  by  ^2~'^^1~'^ 
yields 

bCG)3  =  Cj,C9^  +  C.^se^  -  a  (2.7) 

bSS]-,  =  -CxS9aCa]3  +  CyCe^Caj^  +  C^Sa^  -  d^Sa^        (2.8) 
Sb    =  C^Se^Sab  -  CyCQ^Sab  +  C.Cat  -  d^Ca^         (2.9) 

Squaring  and  adding  Eqs .  (2.7),  (2.8)  and  (2.9)  yields 

b2  +  5^2  =  0^2  +  Cy2  +  0^2  +  da2  .  2c.d^  - 

2aCj^C9a   -    2aCySGa   +   a2  (2.10) 

From  Eq.    (2.9),    we   have 

1 


Cav 


•(CxS9aSai3   -    CyC9aSab  +   C^Ca^   -    s^) 


^b 

Substituting  d^  into  Eq.  (2.10)  yields 

E^X^  +  E2X3  +  E3X2  +  E4X  +  E5  =  0  (2.11) 

where 

X  =  tan(9^/2) 

Dl  =  C^Ca^  -  sj3 

D2  =  0^2  +  C  2  +  0^2  +  a2  -  b2  -  5^2 
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^1  "=  D2C^b  "^  2aCxC2a]-,  -  ZCyC^Saj^Cab  -  2D2_C2Caj3  + 

Cy2s2aj^  +  0^2  +  2DiCySab 
E2  =  -4(aCyC2ab  +  C^c^Sa^Ca^   -    DiC^Sab  -  CxCyS2av3) 
E3  =  2(D2c2a]3  -  ZDiC^Ca^  +  ZC^^sZ^tj^  _  Cy^sSa^  +  ^^2) 
E4  =  -4(aCyC2aj3  +  Cy-C^Sa^^Ca^    -   DiC^Sa]-,  +  C^CyS^aj^) 
E5  =  D2C^o.^    -    2aCxC2aj3  +  iCyC^Sa^^^Ca^^   -    2T)iC^Ca^   + 


C  2s2aj3  +  Di^ 


2D 


iCySab 


Since  Eq.  (2.11)  is  a  fourth-degree  polynomial 
equation,  there  are  up  to  four  possible  solutions  for 
variable  X  (or  9^).   Back  substituting  9^  into  Eqs .  (2.7) 
and  (2.9),  we  can  obtain  up  to  four  possible  sets  of 
solutions  of  9j3  and  d^,  respectively.   Therefore,  the 
subchain  (R-L)-R-S  has  a  fourth-degree  polynomial  equation 
in  inverse  l^inematics. 

Numerical  example.   The  given  parameters  are  as 
follows: 

a  =  2",  b  =  12",  sj3  =  8",  av^  =  72°  and  C°   =    [-4.86, 
-11.60,  3.97]T 

The  four  possible  solutions  are  computed  as 


Solutions 

9a 

(deg. ) 

da 
(m.  ) 

9b 
(deg. ) 

1 

29.932 

1.557 

180.299 

2 

-50.609 

12.297 

-71.132 

3 

17.534 

7.518 

212.427 

4 

-87.735 

-5.592 

38.407 

37 

2.5.2   Subchain  (R-L)-P-S 

Figure  2.12  shews  a  subchain  (R-L)-P-S.   The  inverse 
kinematics  is  similar  to  that  of  the  subchain  (R-L)-R-S.   We 
can  write  the  equation  to  express  the  location  vector  of 
point  C  with  respect  to  the  local  fixed  coordinate  system 
oxoYqZo  as  follows: 


A1A2C 


(2.12) 


r         1         r 
Cx 

1 

L             J 

C8, 
S8- 

0 

0 

1 
0 
0 
0 


b 
0 

db 

1 


ce^(a  +  b)  +  se^Saj^dj^ 

S8^(a  +  b)  -  ce^Sa^dj^) 

da  +  Sa^db 

1 


0     0 
Cat   -Sa^ 

0      0 


(2.13)** 


Premultiplying  both  sides  of  Eq.  (2,12)  by  A2"-^A;l~"'" 
yields 

b   =  C„C9-,  +  C,,sea  -  a  (2.14) 


**  C°  can  also  be  obtained  by  using  the  method  in  [44] 
which  is~presented  in  Appendix  A. 2. 
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Figure    2.12      Subchain    (R-L)-P-S 


0  =  -c. 


db  =  CxSe^Sab  -  C^ce^Sab  +  C^Ca^  -  d^Cab 
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(2.15) 
(2.16) 


Let  tan(e^/2)  =  X,  and  then  substituting  ce^  =  (1  -  X^)/(l   + 
x2)  and  39^  =  2X/ ( 1  +  X^)  into  Eq.  (2.14),  we  obtain 

0  (2.17) 

There  are  up  to  two  possible  solutions  of  X  in  Eq.  (2.17), 
or  up  to  two  possible  solutions  for  G^.   Back  substituting 
these  two  possible  solutions  of  9^  into  Eqs .  (2.15)  and 
(2.15),  we  will  have  up  to  two  possible  solutions  of  d^  and 
d^  from  each  equation.   Thus  it  is  seen  that  this  subchain 
has  a  second-degree  polynomial  equation  in  inverse 
kinematics. 

Numerical  example.   The  given  parameters  are  as 
follows: 

a  =  3",  b  =  2",  a^  =  60°  and  C°  =  [5.85,  -0.13,  4.25]^ 

The  two  possible  solutions  are  computed  as 


Solutions 

^  ©a         d^          db 
(deg.)       (in.)        (in.) 

1 

30.024       2.495        3.510 

2 

-32.570       6.005       -3.510 

2.5.3   Subchain  (R-L)-S-R 

In  Fig.  2.13,  a  schematic  diagram  of  the  subchain 
(R-L)-S-R  is  shown.   The  spherical  pair  is  kinematically 
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Figure    2.13      Subchain    {R-L)-S-R 
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equivalent  to  three  revolute  joints  with  three  mutually 
perpendicular  concurrent  axes.   Since  the  orientation  and 
position  of  the  hand,  H,  is  given,  we  thus  can  obtain  the 
following  equations  with  the  assumption  that  Z3  is  parallel 
to  Z4: 


rO  = 


n^ 
0 

C0a 
S0a 

0 

0 

C©b2 


•S0- 


ce= 


Px 

Py 

Pz 

1 

ace- 

aS0, 


SB 

0 
0 

S8^ 
0 
0 


b2 


-se, 

C9 
0 
0 


S©b2 

-C9b2 

0 

0 

0  cce^ 

0  cse^ 

1  Sc 
0    1 


C©bl 


sQbi  0 


se^i  0  -cebi  0 


09^3  -S9b3  0   bC9b3 

S9b3  -Ceb3  0   bS9b3 

0  0  10 

0  0  0     1 


(2.18) 


where  components  of  the  position  (Pxf  Py  ^i^d  ^p^)    and 
orientation  (nj^,  ny,  n^,  s^,,  Sy,  s^,  a^,  ay  and  a^)    of 
system  Hx4y4Z4  with  respect  to  the  local  fixed  coordinate 
system  oxgyoZg  are  all  specified;  and  9]-|]_ ,  9]-,2  and  8533  are 
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the  three  rotational  variables  of  rhe  spherical  joint  B 
which  play  no  part  in  the  manipulation  of  the  platform. 
Equation  (2.18)  can  be  rewritten  as 


H. 


A1A2A3 


(2.19 


where 


Ai  = 


-se= 


C9 
S9 

0 

0 

cQbi  0 


C9, 

0 
0 


ace^ 


aSQ- 


A-;  = 


S®bl 
0 
0 

C©b3 

S9b3 
0 
0 


sQbi  0 

■c©bi  0 

0  0 

0  1 


C0b2 
S0b2 

0 

0 


■39^3   0   bC9b3 


•C9b3 
0 
0 


bS9 
0 

1 


b3 


S©b2 

-C0b2 
0 
0 

■S9c 

C0C 
0 

0 


cC9^ 


cS9, 


Postmultiplying  both  sides  of  Eq.  (2.19)  by  A3"1a2~-'- 
yields  Eq.  (2.20).   Premultiplying  both  sides  of  Eq.  (2.19) 

^3' 


by  A]_  1  and  then  postmultiplying  both  sides  by  A^'-^   yields 


Eq.  (2.21). 


A]_  =  H°A3-1a2"1 
A2  =  Ai"1hOA3-1 


(2.20) 
(2.21) 
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Since  ([Ai](i^4))2  +  (  [  A^  ]  (  2  ,  4  )  )  "^  =  ^  ^^^^I'^^^l'^-Ul ,  i) ''^    + 
(  [H°A3"^A2~-'- ]  ( 2  4))^  is  true,  we  can  obtain  the  following 
equation: 

a2  =  [-n^lc  +  bce^)  +  bS^SG^  -  a^^S^,  +  Pj^J^  + 

[-ny(c  +  bce^)  +  bSySe^  -  aySc  +  PyJ^        (2.22) 

Equation  for  9^  is  obtained  since  [A]_](2  4)  /  [A]_](]_  4)  = 
[HOA3"iA2"l] (2,4)  /  [H°A3~iA2"^ ] ( 1 ^ 4 )  holds,  and  can  be 
expressed  as 


-ny(c  +  bC9^)  +  SybS9(^  -  ayS^  +  p„ 

9^  =  tan-l( —)    (2.23 

-nj^(c  +  bC9(;,)  +  SxbS9(,  -  a^s^  +  Px 


It  is  observed  that  [A3_](3  4)  =  [H°A3"1a2~-'- ]  { 3  4)  directly 
implies  the  translation  of  joint  A  as 

d^  =  -n2(c  +  bC9c)  +  s^bsg^  -  a^s^  +  Pz  (2.24) 

Let  tan(9c/2)  =  X;  then  substituting  09^  =  (1  -  X^ ) / (1  +  x^ ) 
and  39^  =  2X/ ( 1  +  X^ )  into  Eqs.  (2.22)  yields 

E^X^  +  E2X^  +  E3X2  +  E4X  +  E5  =  0  (2.25) 

where 

°1  =  ('^x^  "^  ny2)b2 

D2  =  (3^2  +  Sy2)b2 

D3  =  2b(nj^2Q  +  ny2c  +  nj^aj^s^,  +  nyavS^  -  Px^^x  ~  Py^y) 

D/i  =  -2b(nvSvC  +  n,rS,rC  +  s^a^s^  +  s,,a,,s 


XSxC   +   HySyC   +   Sj^a^Sc   +   SyayS^   -   S^Px   -SyPy) 
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2ayScPY  "  ^^ 
El  =  Di  -  D3  +  Dg 
E2  =  2(D4  -  D5) 
E3  =  -2(Di  -2D2  -  Dg) 
E4  =  2(D4  +  D5) 


It  is  seen  that  there  is  a  maximum  of  four  solutions  of 
X  (or  9^;)  in  Eq.  (2.25).   Back  substituting  the  values  of  9^ 
into  Eq.  (2.23)  and  (2.24)  yields  up  to  four  sets  of 
solutions  for  9^  and  d^. 

From  Eq.  (2.21),  we  can  find  certain  relationships  by 
equating  corresponding  elements  of  the  two  matrices  on 
either  side  of  the  equation.   Thus  we  obtain  the  following 
equations : 


-aj,S9a  +  ayC9a 

9i3i  =  tan-l( )  (2.26) 

^xC®a  +  ayS9a 


axC9a  +  ayS9a 
)^2   =  tan-l( )  (2.27 


■azCQbl 


n2S9c  +  s2C9c 
9^3  =  tan-l( )  (2.28 
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Since  the  subchain  of  (R-L)-S-R  has  a  fourth-degree 
polynomial  equation  in  inverse  kinematics,  there  are  up  to 
four  possible  solutions  in  Eq.  (2.25).   However,  the 
possible  solutions  may  be  reduced  due  to  special  dimensions 
of  the  subchain  as  shown  in  the  following  example. 

Numerical  example.   The  given  parameters  are  as 
follows: 

a  =  5",  b  =  3",  a^  =  o°,  c  =  0.75",  s^  =  1.50"  and 


ro 


0 

9300 

-0.3323 

-0.1574 

8.3382 

0 

3466 

-0.9352 

-0.0734 

0.2201 

0 

1228 

0.1228 

-0.9848 

-1.5205 

0 

0 

0 

1 

Since  two  of  the  solutions  of  Eq.  (2.25)  are  complex 
numbers,  the  remaining  two  possible  real  solutions  are 
computed  as 


Solutions 

©c 
(deg. ) 

©a 
(deg. ) 

da 
(in.  ) 

©bl 
(deg. ) 

0b2 
(deg. ) 

1 

9b3 
(deg. ) 

1 

33.435 

-1.008 

0.559 

26.009 

-10.002 

11.565 

2 

14.988 

10.009 

0.500 

14.992 

-10.002 

30.012 

2.5.4   Subchain  (R-L)-S-P 

The  procedure  of  inverse  kinematics  of  the  subchain  (R- 
L)-S-P,  as  shown  in  Fig.  2.14,  is  similar  to  that  of  the 
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Figure    2.14      Subchain    (R-L)-S-P 
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subchain  (R-L)-S-R  in  2.5.3.   Therefore,  we  can  obtain  the 
following  equation: 


H. 


A1A2A3 


(2.29) 


where 


rO  = 


Ai  = 


At  = 


ce, 
se. 

0 

0 

C9 
S8 

0 
0 


bl 


bl 


SG 
0 
0 


b3 


•se. 


C9= 


Px 

Py 

Pz 

1 

aC8- 

ase. 


0 
0 

1    d, 

0    ; 

S0bi  0 

■c©bi  0 

0  0 

0  1 


C9b2 

S©b2 

0 

0 


C8b3   -39^3   0 


■C9b3 
0 
0 


bceb3 
bseb3 

0 

1 


S0b2 

•C©b2 

0 

0 

0 
0 

1 

0 


0 
0 
0 

1 

c 
0 

dc 

1 


where  components  of  the  position  (pj^,  py  and  p^ )  and 
orientation  (n^,,  ny,  n^,  s^,  Sy,  s^,  a^,  ay  and  a^)    of 
system  Hx3y3Z3  with  respect  to  the  local  fixed  coordinate 
system  oxgYoZQ  ^^^  ^^^  specified;  and  Q]^i ,    9^,2  ^^^   ©bS  ^^^ 
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the  three  rotational  variables  of  the  spherical  joint  B, 
which  play  no  part  in  the  manipulation  of  the  platform. 

Postmultiplying  both  sides  of  Eq.  (2.29)  by  A3"1a2~-^ 
yields  Eq.  (2.30).   Premultiplying  both  sides  of  Eq.  (2.29) 
by  A]_~^  and  then  postmultiplying  both  sides  by  A3"-'-  yields 
Eq.  (2.31). 

Ai  =  H°A3"^A2'^  (2.30) 

A2  =  Ai"1hOA3"1  (2.31) 

Since  ([Ai](i^4))2  +  ([^i]{2,4)^^   =    ^  ^^°^3'^^2~'^Ul  ,A)  "f^   + 
(  [H°A3~^A2~-'- ]  (  2  4 )  ) '^  is  true,  we  can  obtain  the  following 
equation: 

(ajj^  +  ay2)d(-,2  +  2[(c  +b)nj^aj^  +  (c  +  b)nyay  -  aj^p^ 
-ayPyldc  +  (c  +  b)2(nx2  +  ny2 )  +  p^2  +  p^2  _ 
2(c  +  bXn^Px  +  HyPy)  -  a2  =  0  (2.32) 

Equation  for  8^  is  obtained  since  [A]_](2,4)  /  \.^l]{l,4)    = 
[HOA3"lA2"i] (2,4)  /  [H°A3"lA2"i ] (1 ^ 4 )  holds,  and  can  be 
expressed  as 


- ( c  +  b ) ny  -  ayd^  +  Py 
.a  -  tan-M —]  (2.33) 


(c  +  b)nj^  -  ajjd^  +  Pjr 


It  is  observed  that  [Ai](3^4)  =  [H°A3  iA2  -^1(3,4)  directly 
implies  the  translation  of  joint  A  as 

d^  =  -(c  +  b)n2  -  a^dp.  +  p^  (2.34) 
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From  Eq.  (2.31),  we  can  find  certain  relationships  by 
equating  corresponding  elements  of  the  two  matrices  on 
either  side  of  the  equation.   Thus  we  obtain  the  following 
equations : 


-axS9a  +  a,^C9a 
9^1  =  tan-l( 


(2.35) 


='b2 


tan-l( 


:C9bi 


(2.36) 


i)b3  =  tan-l( —) 


(2.37) 


There  are  two  possible  solutions  for  d^;,  in  Eq.  (2.32), 
since  it  is  a  quadratic  polynomial  equation.   Back 
substituting  these  solutions  of  d^  into  Eqs .  (2.33)  - 
(2.37),  respectively,  we  can  obtain  two  possible  sets  of 
solutions  for  9^,  d^,  Q-^i,    Q\^2   ^^*^  ®b3  f^o^i  each  equation. 
Therefore,  the  subchain  (R-L)-S-P  has  a  second-degree 
polynomial  equation  in  inverse  kinematics. 

Numerical  example.   The  given  parameters  are  as 
follows: 

a  =  3",  b  =  2",  a^,  =  0°,  c  =  0.25"  and 


BP 


0.7259 

0.5900 

0.3536 

5.1151 

0.4803 

-0.8027 

0.3536 

3.4645 

0.4924 

-0.0868 

-0.8660 

0.4428 

0 

0 

0 

1 
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The  two  possible  solutions  are  computed  as 


Solutions 

d^       9a 
(iH.)   (deg.) 

da 
(  in.  ) 

©bl 
(deg. ) 

9b2 
(deg. ) 

1 

0b3 
(deg. ) 

1 

2.499   30.001 

1.499 

14.999 

30.004 

9.997 

^ 

14.089  239.999 

11.536 

-14.999 

-30.004 

189.997 

2 . 6   Sunmnary 
The  equations  of  inverse  kinematics  have  been  derived 
for  the  dyads  (R-L)-R-S,  (R-L)-P-S,  (R-L)-S-R  and  (R-L)-S-P 
as  shown  in  Fig.  2.7,   each  of  which  has  six  degrees  of 
freedom.   Numerical  examples  have  been  shown  to  illustrate 
the  possible  solutions  for  each  subchain.   The  degrees  of 
polynomial  equations  in  inverse  kinematics  for  the  dyads 
with  six  degrees  of  freedom  are  summarized  in  Table  2.1. 


Table  2.1  Degree  of  polynomial  equation  in  inverse 
kinematics 


1 

Type  of  dyads 

Degree  of  polynomial  equation 

(R-L)-R-S 

4 

(R-L)-P-S 

2 

(R-L)-S-R 

4 

(R-L)-S-P 

The  detailed  analysis  and  polynomial  equation  occurring 
in  inverse  kinematics  can  be  obtained  using  several  methods. 
The  reader  is  advised  to  see  the  literature  on  kinematic 
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analysis  of  spatial  mechanisms,  particularly  the  work  by 
Duffy  [44]. 

Hunt  [45]  pointed  out  that  a  serially-actuated  arm 
accumulates  errors  from  the  shoulder  out  to  the  end- 
effector;  also,  such  arms  often  suffer  from  lack  of  rigidity 
and,  in  the  absence  of  sophisticated  techniques  of  computer- 
control  compensation,  are  subject  to  load-dependent  error. 
They  also  suffer  relatively  low-frequency  oscillations. 
With  in-parallel-actuation  by  ground-mounted  actuators, 
there  are  the  advantages  of  both  greater  rigidity  and 
lightness  of  the  linkage,  but  at  the  expense  of  more  limited 
workspace  and  dexterity.   Since  actuator-error  is  not 
cumulative,  greater  precision  is  likely  to  be  attainable 
without  excessive  control  complications.   There  should 
surely  be  a  future  for  in-parallel-actuation  by  ground- 
mounted  actuators  in  robotic  devices. 


CHAPTER  3 
WORKSPACE  ANALYSIS  OF  THE  MANIPULATORS 


3.1  Introduction 
This  chapter  deals  with  the  workspace  of  a  parallel 
manipulator  having  three  rotary-linear  (R-L)  actuators  on 
grounded  cylindric  joints,  three  revolute  and  three 
spherical  pairs  as  shown  m  Fig.  3.1.   The  workspace  is 
defined  as  the  reachable  region  of  the  origin  of  the  moving 
coordinate  system  embedded  in  the  six-degree-of -freedom 
platform  of  the  manipulator.   Since  the  mechanism  consists 
of  three  subchains,  the  workspace  is  the  common  reachable 
region  of  three  subworkspaces  determined  by  the 
corresponding  subchains.   The  subworkspace  described  in  this 
chapter  is  defined  as  the  workspace  of  the  center  of  the 
platform  determined  by  a  subchain  regardless  of  the 
constraints  imposed  by  the  other  subchains.   The  dimensions 
of  the  platform  are  considered  to  be  infinitesimal  and 
therefore  the  workspace  is  determined  without  considering 
the  orientation  of  the  platform  in  this  chapter^.   When  the 
R  joint  rotates  about  the  C  joint  without  translation  and 
the  spherical  joint  rotates  about  R  joint,  the  locus  of  the 
spherical  joint  at  the  end  of  a  dyadic  subchain  is  the 


^Workspaces  with  finite-size  platform  are  derived  in 
Chapter  4. 
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R-L  Actuator 


Figure  3.1   Six-degree-of -freedom  closed-loop  manipulator. 
C:  Cylindric  joint,  R:  Revolute  joint,  S: 
Spherical  joint. 
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surface  of  a  torus.   The  subworkspace  of  each  open  subchain 
is  the  volume  swept  by  this  torus  translated  along  the  axis 
of  each  ground-mounted  (R-L)  joint.   In  this  chapter,  the 
shapes  of  the  above-described  torus  of  the  subchain  are 
studied  for  different  dimensions  of  the  links.   The 
conditions  on  the  dimensions  of  the  links,  for  which  the 
subworkspace  has  no  hole,  are  presented.   Of  course,  an 
infinitesimally  small  platform  is  not  practical,  because  the 
three  spherical  pairs  supporting  the  platform  coincide. 
Therefore  the  platform  has  no  controllability  of  its 
orientation.   To  have  controlled  orientation,  the  platform 
requires  three  controllable  rotational  degrees  of  freedom 
with  concurrent  non-coplanar  axes.   This  is  attained  by 
placing  the  three  spherical  joints  at  finite  distances  from 
one  another.   Nevertheless,  the  workspace  study  with 
infinitesimally  small  platform  is  a  useful  step  toward  more 
practical  workspace  studies  with  finite-size  platforms 
having  controllable  orientation,  which  will  be  covered  in 
Chapter  4 . 

One  basic  need  in  the  design  of  mechanical  manipulators 
is  to  determine  the  shape  of  the  workspace.   Workspace 
analysis  of  mechanical  manipulators  has  been  investigated  by 
many  authors.   Almost  all  the  studies  are  related  to 
open-loop  multi-degree-of-freedom  serial-link  mechanical 
manipulators.   Little  work  has  been  done  in  the  area  of 
mechanical  manipulators  with  parallel  kinematic  chains. 
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Therefore,  theories  for  the  workspace  of  such  parallel 
mechanical  manipulators  are  needed. 

3 . 2   Configuration  of  a  Parallel  Manipulator 
with  R-L  Actuators 

A  six-degree-of -freedom  parallel  manipulator,  where 
all  actuators  are  ground-mounted,  is  considered  in  this 
chapter.   It  has  three  six-degree-of -freedom  subchains,  each 
of  which  has  a  two-degree-of -freedom  R-L  actuator,  which 
controls  both  the  rotation  and  the  translation  of  a  ground- 
supported  cylindrical  joint.   For  reducing  the  number  of 
links  in  the  subchains,  spherical  joints,  which  are  three- 
degree-of -freedom  kinematic  pairs,  are  used  in  the 
subchains.   A  Cylindric-Revolute-Spherical  ((R-L)-R-S)  triad 
may  then  be  used  as  the  subchain  with  the  C  joint  (R-L 
actuator)  connected  to  the  ground,  and  the  S  joint  connected 
to  the  end-effector  platform  of  the  manipulator.   The  axes 
of  the  C  joints  (R-L  joints)  on  the  frame  may  be  arranged  in 
several  different  configurations,  such  as  star  form, 
triangle  form,  or  parallel  to  each  other,  as  shown  in  Fig. 
3.2.   Furthermore,  they  need  not  be  coplanar,  even  if  they 
are  not  parallel  to  one  other. 

The  lengths  from  the  center  of  the  platform,  H,  to  the 
centers  of  the  spherical  joints,  C]_,  C2  and  C3,  affect  the 
volume  of  the  workspace,  and  more  significantly,  the 
rotatability  of  the  platform  about  the  center  H.   Thus,  to 
get  a  workspace  of  the  manipulator  with  rotatability  of  the 
end  effector  as  large  as  possible,  the  lengths  between  H  and 
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Figure  3.2   Three  possible  configurations  of  the 

arrangements  of  the  R-L  actuators  on  the  base, 
Also,  the  R-L  actuators  need  not  be  either 
parallel  or  coplanar. 
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Cj_  (i  =  1,  2  and  3)  should  be  as  small  as  possible,  which  is 
consistent  with  controllability  of  end-effector  orientation. 
When  the  lengths  are  infinitesimal  or,  in  the  limit,  zero, 
the  largest  possible  workspace  with  complete,  but 
uncontrollable  rotatability  of  the  platform  results.   In 
this  chapter,  the  equations  of  the  workspace  of  the 
manipulator  with  infinitesimal  dimensions  of  the  platform 
are  derived,  i.e.,  with  joints  C^,    C2  and  C3  inf initesimally 
close  to  each  other.   In  chapter  4,  the  workspace  of  a 
similar  parallel  manipulator  with  a  finite  size  platform 
will  be  determined.   Of  course,  controllability  of  the 
orientation  of  the  platform  is  reduced  sharply  as  the 
spherical  joints  approach  one  another.   Therefore  it  must  be 
realized  that  there  must  be  a  practical  trade-off  between 
the  distances  of  the  spherical  joints  from  one  another  and 
the  controllability  of  platform  orientation. 

3 . 3   The  Subworkspace  Analysis  of  the  Manipulator 
The  toroidal  surface  (torus)  is  the  locus  of  a  point 
attached  to  a  body  that  is  jointed  back  to  the  reference 
system  through  a  dyad  of  two  serially  connected  revolute 
pairs.   A  general  R-R  dyad  with  a  point  C  which  traces  the 
surface  of  a  general  form  of  torus  is  shown  in  Fig.  3.3.   It 
is  similar  to  the  subchain  {R-L)-R-S  when  the  platform  is 
assumed  to  be  infinitesimal  and  without  the  consideration  of 
translation  along  the  axis  of  the  cylindric  (R-L)  joint. 
The  shapes  of  the  torus  are  illustrated  first,  then  the 
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Figure  3 . 3 


An  R-R  (Revolute  -  Revolute)  dyad  with  a  point  C 
tracing  a  general  form  of  torus.   Note  that  a  is 
the  common  perpendicular  of  the  axes  of  the 
revolutes  A  and  B. 
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equations  of  the  boundaries  of  the  subworkspace ,  which  is 
the  voluine  swept  by  this  torus  as  the  R-L  joint  translates, 
will  be  derived. 

3.3.1   Shapes  of  the  subworkspace 

Fichter  and  Hunt  [51]  have  geometrically  described  and 
analyzed  four  forms  of  the  torus,  which  are  common, 
flattened,  symmetrical-offset  and  general  forms  as  shown  in 
Fig.  3.4.   They  also  introduced  two  types  of  bitangent- 
plane^,  a- type,  whose  quartic  curve  intersection  with  the 
torus  always  encircles  the  OZ  axis  and  B-type,  whose  points 
of  tangency  are  both  on  one  side  of  the  OZ  axis.   Any 
bitangent-plane  to  any  form  of  torus  cuts  the  torus  in  two 
circles  of  the  same  radius  which  intersect  one  another  at 
the  two  points  of  tangency.   The  curve  of  intersection  of 
the  bitangent-plane  and  the  torus  can  be  obtained  by  the 
simultaneous  solution  of  the  equations  of  the  bitangent- 
plane  and  the  torus.   The  curve  of  intersection  of  A-type 
bitangent-plane  and  a  common  torus  (a  >  b)  is  shown  in  Fig. 
3.5. 

The  equation  of  the  surface  of  a  completely  general 
form  of  torus  can  be  expressed  as  follow: 


'^    A  bitangent-plane  has  two  points  of  tangency  with  a 
toroidal  surface. 
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t 


2  Edge  view  of  A- type 

bitangent-plane 


(a)   Common  torus 


Edge  view  of  A- type 
bitangent-plane 


(b)   Flattened  torus 


Figure    3.4      Diametral   sections    through   tori:     (a)    common, 
(b)    flattened,    (c)    symmetrical-offset   and    (d! 
general   types. 


61 
( continued) 


Edge   view  of   B-type 
bitangent-plane 


/  Edge   view  of  A- type 
-       bitangent-piane 


(c)   Symmetrical-offset  torus 


▲  Z 


Edge  view  of  B-type 
bitangent-plane  '~~^*'/ 


Edge  view  of  A-type 
bitangent-plane 


(d)    General  torus 
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Curve  of  Intersection 

(common  torus  and  A-type  pianej 
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Figure  3.5   Intersection  of  the  A-type  bitangent-plane  and 
the  right  circular  torus  (a  =  3",  b=  2") 
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:2)  -  (a2  +  b2  +  s2)}2 

z  -  scosa 

4a2{b2  -  ( )2}         (3.1)3 

sina 


Common  form.   The  common  form  of  torus  (right 
circular),  sometimes  called  the  anchor-ring,  is  shown  in 
diametral  section  in  Fig.  3.4(a).   The  axes  of  the  two 
revolute  pairs  are  at  right  angle  (a  =  90°).   Their  common 
perpendicular  is  a  and  the  offset  between  them  is  zero  (s  = 
0)  (see  Fig.  3.3).   The  equation  of  the  torus  can  be 
expressed  as 

{(x2  +  y2  +  z2)  -  (a2  +  b2)}2  =  4a2(b2  -  z2)       (3.2) 

The  difference  between  the  lengths  of  the  links  affects  the 
shape  of  the  torus,  which  is  illustrated  in  Fig.  3.6.   As  a 
>  b  shown  in  Fig.  3.6(a),  the  two  circles  in  the  diametral 
section  are  separated  by  a  distance  of  2  (a  -  b)  .   This  ]<ind 
of  torus  is  also  shown  in  Fig.  3.7.   When  the  two  circles  in 
the  diametral  section  are  tangent  at  a  point,  the  origin  0, 
then  a  =  b  as  shown  in  Fig.  3.6(b).   The  torus  will 
intersect  itself  when  a  <  b  as  shown  in  Fig.  3.6(c).   There 
is  a  void  in  this  kind  of  torus  when  a  <  b  exists. 

Flattened  form.   The  flattened  form  of  torus  has  no 
offset  (s  =  0)  either,  but  the  axes  of  the  two  revolute 


3  The  equation  of  the  general  form  of  torus  is  derived 
in  Appendix  B. 
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Figure  3.6   Diametral  section  of  the  common  form  of  torus 
(a)a>b,  (b)a=b  and  (c)  a  <  b 
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Figure  3.7   A  right  circular  torus,  a  >  b. 
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pairs  are  not  at  right  angle  (a  9^  90°).   The  equation  of 
this  form  of  torus  can  be  expressed  as 

z2 

{(x2  +  y2  +  ^2)  _  (a2  +  b^ )  }  2  =  4a2(b2 — ) 

sin^a 

(3.3) 

The  diametral  plane  cuts  the  torus  in  egg-shaped  curves  as 
shown  in  Fig.  3.4(b).   For  different  twist  angles  (30°,  45° 
and  75°)  and  dimensions  of  the  links  (a  >  b,  a  =  b,  and  a  < 
b)  with  each  specified  twist  angle,  the  shapes  of  the  torus 
are  shown  in  Figs.  3.8  -  3.10,  respectively.   It  is  noticed 
that  the  diametral  sections  of  these  tori  are  similar  to 
those  of  the  common  form  when  a  >  b  and  a  =  b,  but  flattened 
and  egg-shaped.   But  the  tori  in  Figs.  3.8  -  3.10  do  not 
intersect  themselves  when  a  <  b,  which  differs  from  the 
schematic  shown  in  Fig.  3.6(c). 

Symmetrical-offset  form.   The  symmetrical-offset  form 
has  the  axes  of  the  two  revolute  pairs  at  right  angle  (a  = 
90°)  and  with  offset  (s  ^  0).   The  equation  of  this  form  of 
torus  can  be  expressed  as 


/(x2  +  y2  +  z2)  _  (^2  +  b2  +  s2)}2  =  4a2(b2  -  z^ ) 

(3.4) 


The  diametral  section  of  this  kind  of  torus  is  shown  in  Fig, 
3.4(c).   For  a  >  b  and  small  s,  the  shape  of  the  torus  as 
shown  in  Fig.  3.11(a)  is  slightly  different  from  that  in 
Fig.  3.6(a).   As  shown  in  Fig.  3.11(b),  the  inner  walls  of 
the  anchor-ring  become  flatter  when  a  =  b.   The  two  closed 
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-^-°-e^ 


(a) 


(b) 


Figure  3.8   Diametral  section  of  the  flattened  form  of  torus 
(a=30°):  (a)  a>b,  (b)a=b  and  ( c )  a  <  b 
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(a) 


(b) 


(c) 


Figure  3.9   Diametral  section  of  the  flattened  form  of  torus 
(a=45°):  (a)a>b,  (b)a=b  and  (c)  a  <  b 
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Figure  3.10   Diametral  section  of  the  flattened  form  of 
torus  (a=75°):  (a)a>b,  (b)a=b  and 
(c)  a  <  b 
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(a) 


(b) 


Figure  3.11   Diametral  section  of  the  symmetrical-offset 
form  of  torus:  (a)a>b,  (b)  a=b  and 
(c)  a  <  b 
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curves  in  the  diametral  section  become  banana-shaped,  as 
shown  in  Fig.  3.11(c),  when  a  <  b. 

General  Form.   The  diametral  section  of  the  torus  is 
shown  in  Fig.  3.4(d).   For  different  twist  angles  (30°,  45° 
and  75°)  and  dimensions  of  the  links  (a  >  b,  a  =  b,  and  a  < 
b)  with  each  specified  twist  angle,  the  shapes  of  the  torus 
are  shown  in  Figs.  3.12  -  3.14,  respectively.   The  closed 
curves  in  the  diametral  section,  while  still  more  or  less 
banana-shaped,  but  now  they  are  tilted  over. 

Equations  (3.1)  -  (3.4)  are  all  of  the  fourth  degree 
and  all  forms  of  torus  are  thus  quartic  surfaces.   The  curve 
of  intersection  between  a  torus  and  a  general  plane  is  a 
quartic;  also,  in  general,  a  straight  line  cuts  any  torus  in 
four  points  (real,  imaginary,  or  coincident). 

The  volume  and  shape  of  the  workspace  are  very 
important  for  applications  since  they  determine  capabilities 
of  the  robot.   In  order  to  obtain  the  optimum  workspace,  the 
volume  of  the  subworkspace  of  the  corresponding  subchain 
generally  should  be  as  large  as  possible.   Since  most  of 
today's  available  industry  robots  have  0°  or  ±90°  twist 
angles,  we  will  discuss  the  following  two  cases  with  the 
conditions  of  s  =  0  and  twist  angle  a  =  0°  or  ±90°  applied, 
respectively. 

Case  1:    s  =  0  and  a  =  0°  (or  ±  n) 

Since  the  axes  of  the  two  revolute  pairs  are  parallel 
and  there  is  no  offset,  the  toroidal  surface  degenerates 
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(a) 


(b) 


(c) 


Figure  3.12   Diametral  section  of  the  general  form  of  torus 
(a=30°):  (a)a>b,  (b)a=b  and  (c)  a  <  b 
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(a) 


^ 

0 

Figure  3.13   Diametral  section  of  the  general  form  of  torus 
(a=45°):  (a)a>b,  (b)a=b  and  (c)  a  <  b 
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Figure  3.14   Diametral  section  of  the  general  form  of  torus 
{a=75°):  (a)  a>b,  (b)  a=b  and  (c)  a  <  b 
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into  a  plane.   For  different  dimensions  of  the  links  a  and 
b,  the  shapes  of  the  now  planar  toroidal  surface  are 
illustrated  in  Fig.  3.15.   The  workspace  resulting  when  this 
surface  is  translated  along  the  Z  axis  has  no  hole  only  when 
a  =  b  as  shown  in  Fig.  3.15(b). 

The  workspace  of  this  kind  of  subchain  is  generally  the 
volume  between  two  coaxial  cylinders  when  the  translation 
along  the  Z  axis  is  in  effect.   Due  to  the  limitation  of  the 
rotation  of  the  first  revolute  joint  which  is  ground- 
mounted,  the  workspace  of  this  subchain  is  actually  reduced 
to  the  upper  half  (X  >  0)  of  the  volume  between  the  two 
coaxial  cylinders.   Whenever  the  condition  a  =  b  exists,  the 
inner  boundary  disappears  and  there  is  no  hole  in  the 
workspace. 

Case  2:    s  =  0  and  a  =  ±90° 


Since  the  two  axes  of  the  two  revolute  pairs  are 
perpendicular  to  each  other  and  there  is  no  offset,  the 
locus  of  point  C  is  a  torus,  which  is  defined  as  the  common 
form  of  torus  shown  in  Fig.  3.6.   When  the  translation  along 
the  Z  axis  is  in  effect,  the  workspace  of  the  subchain  can 
be  described  as  shown  in  Figs.  3.16  -  3.18,  respectively. 

In  Fig.  3.16(a),  the  torus  has  a  hole  because  of  a  >  b. 
When  the  translation  d  along  the  Z  axis  is  in  effect,  we 
obtain  the  workspace  as  the  volume  between  the  two  coaxial 
cylinders  with  radii  of  (a  +  b)  and  (a  -  b),  respectively 
and  height  d,  plus  the  volume  of  a  half  torus  at  each  end. 
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Figure  3.15   Cross  sections  of  the  Workspace  generated  by 
the  planar  R-R  dyad:  (a)a>b,  {b)a=b  and 
(c)  a  <  b  (infinitesimal  platform) 
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-^d^       VOID 


Figure  3.16   Workspace  with  the  common  form  of  torus 

(a  >  b);  Along  the  Z  axis:  (a)  d  >  2b  and  (b) 
0  <  d  <  2b  (infinitesimal  platform) 
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Figure  3.17   Workspace  with  the  common  form  of  torus 

(a  =  b);  Along  the  Z  axis:  (a)  d  >  2b  and  (b! 
0  <  d  <  2b  (infinitesimal  platform) 
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Figure  3.18   Workspace  with  the  common  form  of  torus 

(a  <  b);  Along  the  Z  axis:  (a)  d  >  2b  and  (b) 
0  <  d  <  2b  (infinitesimal  platform) 
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However,  this  is  true  only  when  the  translation  along  the  Z 
axis,  d,  is  greater  than  or  equal  to  2b.   Otherwise,  there 
are  additional  voids  that  can  be  found  as  shaded  areas 
shown  in  Fig.  3.16(b).   When  the  translation  along  the  Z 
axis  is  less  than  2b,  there  is  a  void  inside  the  workspace, 
shown  with  a  lentil-shaped  cross  section  in  Fig.  3.16(b). 
When  a  =  b  as  shown  in  Fig.  3.6(b),  there  is  no  hole  as  the 
translation  along  the  Z  axis  is  in  effect  and  d  >  2b.   The 
workspace  is  the  volume  of  the  cylinder  with  radius  of 
(a  +  b),  height  d,  plus  the  volume  of  this  kind  of  half 
torus  at  each  end,  as  shown  in  Fig.  3.17(a).   If  the 
translation  along  the  Z  axis  is  less  than  2b,  voids  can  be 
found  even  if  the  torus  has  no  hole  at  all.   The  lentil- 
shaped  cross  sections  of  the  void  can  be  shown  as  shaded 
areas  in  Fig.  3.17(b).   Finally,  when  the  torus  intersect 
itself  as  shown  in  Fig.  3.6(c),  there  is  a  void  inside  in 
this  torus.   As  the  translation  d  along  the  Z  axis  is  in 
effect  and  is  greater  than  or  equal  to  2b,  we  obtain  the 
workspace  as  the  volume  of  the  cylinder  with  radius  of  (a  + 
b)  and  height  d,  plus  the  volume  of  this  kind  of  half  torus 
at  each  end  as  shown  in  Fig.  3.18(a).   Similarly,  voids  can 
be  found  if  the  translation  along  the  Z  axis  is  less  than 
2b,  which  is  shown  in  Fig.  3.18(b). 

3.3.2   Boundaries  of  the  subworkspace  and  root  regions 
in  the  subworkspace  (infinitesimal  platform) 

In  order  to  calculate  the  volume  of  the  subworkspace, 

we  must  find  the  boundaries  (external  and  internal)  of  the 
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subworkspace.   From  the  inverse  kinematics  of  subchain  ( R- 
L)-R-S  solved  in  section  2.5.1,  we  know  it  has  up  to  four 
possible  solutions  for  a  given  position  of  the  S  joint. 
Once  the  orientation  and  position  of  the  hand  is  given,  we 
may  have  up  to  64  solutions  for  the  manipulator.   Therefore, 
the  study  of  root  regions  in  the  subworkspace  is  also 
important. 

A  manipulator  with  R-L  actuators  in  the  subchains  whose 
axes  are  arranged  in  triangle  form  on  the  base  can  be 
represented  as  shown  in  Fig.  3.19.   The  notation  is  as 
follows: 

OXYZ      —   global  fixed  coordinate  system. 

i         —   i-th  subchain. 

Aj_,  Bj_    —   R-L  actuator  joint  and  revolute  joint  in  the 

i-th  subchain. 
Oj_Xj_yj_z-j_   —   local  fixed  coordinate  systems  with  the  Zj_ 

axis  along  the  axis  of  the  cylindric  joint 

Ai- 
^i^aiYai^ai'  ^i^bi^bi^bi  —   moving  coordinate  systems 

embedded  in  joints  Aj_  and  Bj_, 
respectively. 
®ai'  ®bi   —   relative  rotation  angle  between  successive 

links. 
dj_        —   translation  along  the  axis  Zj_  of  cylindric 

joint  Aj_  from  the  origin  of  the  local  fixed 

coordinate  system  OiX-i_yj_Zj^. 
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Figure  3.19   Notation  of  the  manipulator  with  ground-mounted 
R-L  actuators  arranged  in  triangle 
configuration 
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a.j_,  b-L    —   perpendicular  distance  between  successive 
joint  axes  Z]_,  Z2  and  Z3,  respectively. 

^bi '  '^bi   —   offset  along  axis  z^j^   and  twist  angle  between 
z^-L  and  z-^i,    respectively. 

HCj_       —   approaching  zero  for  infinitesimal  platform. 

As  shown  in  Figs.  3.20  and  3.21  when  Sj3j_  5^  0  or  s-^^   ~   '^ 
respectively,  if  the  revolute  joint  B-j^  makes  a  complete 
rotation,  the  locus  of  the  point  Cj_  is  a  circle  with  respect 
to  the  moving  coordinate  system  Bj_xj-)j_yj-)j_zj-|j_ .   It  can  also  be 
expressed  with  respect  to  the  coordinate  system  Aj_X3J_yaj_Zaj_ 
from  Eq.  (2.5)  as  follows: 

Xai  =  biC9bi  +  ai  (3.5) 

Yai  =  biSebiCa^i  -  SbiSa^i  (3.6) 

Zai  =  biSe^iSabi  +  SbiCa^i  (3.7) 

The  locus,  generated  by  the  point  Cj_  turning  around  the 
revolute  joint  B.j_  and  the  cylindric  joint  A^,  without 
translating  along  the  axis  of  the  cylindric  joint,  can  be 
obtained  by  turning  the  circle,  now  represented  by  Eqs. 
(3.5)  and  (3.6),  about  the  Zg^j_   axis.   The  shape  of  this 
locus  is  the  surface  of  a  general  form  of  torus  as  described 
in  section  3.3.1.   The  subworkspace  of  this  subchain  is  the 
volume  swept  by  this  toroidal  surface  as  it  translates  along 
the  axis  of  the  cylindric  joint. 
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Figure  3.20   Subworkspace  element  of  the  i-th  dyad  of  the 

manipulator  as  the  offset  at  joint  Bj_,  sj-)j_  i^   0 
(infinitesimal  platform) 


b.sine^.cosaj^. 


Figure  3.21   Subworkspace  element  of  the  i-th  dyad  of  the 

manipulator  as  the  offset  at  joint  Bj_,  s^^  =  0 
(infinitesimal  platform) 
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Since  the  manipulator's  workspace  with  infinitesimal 
platform  is  the  common  intersection  of  the  three 
subworkspaces  of  the  three  dyads  that  support  the  platform, 
in  general  the  ends  of  these  subworkspaces  need  not  be 
considered.   Therefore,  only  the  projection  of  the 
subworkspace  onto  the  xy  plane  is  of  interest.   For  this 
reason,  henceforth  r  will  designate  only  the  xy  projection 
of  the  vector  from  the  center  A.i_  to  the  cylindric  boundary 
of  the  subworkspace.   Accordingly: 

r2  =  Xai2  +  y^. 2  =  ^^2  +   yi2 

=  (biCGbi  +  ai)2  +  (biSebiCabi  -  SbiSabi)2      (3.8) 

Subworkspace  with  offset  s^j  =  0   (infinitesimal 
platform) .   For  the  sake  of  simplicity  and  ease  of 
visualization,  we  will  discuss  the  subworkspace  with 
infinitesimal  platform  and  with  offset  s^i  =  0  first.   Eq. 
(3.8)  becomes 

r2  =  (biC9v,i  +  ai)2  +  ^±^5^@hi^^^hi  (3.9) 

The  projections  on  the  Oj_Xj_yj_  plane  of  the  circles 
described  by  Cj_,  which  are  ellipses,  can  be  represented  by 
Eqs.  (3.8)  and  (3.9)  in  terms  of  the  parameter  e^i-   Figs. 
3.20  and  3.21  show  these  ellipses  when  aj_  >  b.j_.   When 


'^See  page  102  for  subworkspace  with  offset  s^i  ?^  0. 
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cylindric  joint  Aj^  translates  along  its  fixed  axis  z^,  the 
subworkspace  with  respect  to  the  system  Aj^xj^y-^z-l  is  the 
volume  between  two  concentric  cylinders  without  considering 
the  two  ends  of  the  subworkspace.   The  radii  of  the  external 
and  the  internal  cylinders  are  respectively  the  maximum  and 
the  minimum  radii  of  the  torus  described  by  Cj_   without 
translation.   Taking  the  derivative  of  r  expressed  by  Eq. 
(3.9)  with  respect  to  Q-^^   and  making  the  resulting 
expression  equal  zero,  we  can  obtain  the  maximum  and  minimum 
radii  of  the  torus  from  the  following  equation 

dr 

r  =  -biSebi(bj_cebiS2abi  +  a^)  =  0  (3.10) 

dSbi 

Then  we  obtain  the  following  two  equations 

se^i  =0  (3.11) 

and 

CQbi  = ^ (3.12) 

biS^a^i 

When  Sa]-,j^  =  0  (a^j.   =  0  or  tx)  (the  circles  described  by 
Bj_   and  C^   are  coplanar),  or  aj^  >  b-LS^a]-,.^,  no  real  roots  of 
Q^l   ^^^  b^  found  in  Eq.  (3.12).   Hence  we  only  have  two 
roots  of  Q-^^   from  Eq.  (3.11),  i.e.  e^j_  =  0  and  9^^  =  n.      In 
this  case,  the  values  of  r  corresponding  to  6gj_  and  6gj_  are 
respectively  the  maximum  and  minimum  values  of  r. 
Therefore,  substituting  the  value  of  e^j^  and  9^^  into  Eq. 
(3.9)  yields  the  maximum  and  minimum  values  of  r  as  follows: 


and 

^min^  =  (^i  -  bi)2  =  r2i2,  (3.14) 


which  are  intuitively  correct. 

The  relationship  between  r  and  Q-^^  can  be  expressed  in 
a  Cartesian  coordinate  system  as  shown  in  Fig.  3.22.  It  is 
obvious  that  in  the  subworkspace  where  r2i  <  r  (= 


V  Xj_2  +  y^2)  <  j,^^^  fQj.  ^  given  position  of  point  Cj_,  which 
implies  a  given  value  of  r,  there  are  two  corresponding 
solutions  of  9j3j_ .   The  subworkspace  is  a  two-root  region  or 
two-way  accessible  region.   In  other  words,  there  are  two 
sets  of  e^j_  and  Q]^i,    or  two  kinematic  branches  of  the  i-th 
dyad  for  reaching  a  given  position  of  Cj_.   On  the  boundaries 
where  V  Xj_2  +  y^2  =  ^^^   ^^   j.^^^  there  is  only  one  solution 
for  ej-,j_.   Thus  the  boundary  surfaces  are  one-root  regions. 
(Recall  that  this  is  a  planar  R-R  case). 

In  another  case,  when  Saj-,j_  /  0  {a-^i   r   0   or   n)    and  aj_  < 
bj_s2aj3j_,  two  additional  roots  of  6^^   are  found  from  Eg. 
(3.12).   Therefore  in  addition  to  r]_i  and  r2i  there  are 
another  two  values  of  r,  say  r3j_  and  r4j_,  which  are  also 
limiting  values  of  Eq.  (3.9). 

Substituting  Eg.  (3.12)  into  Eg.  (3.9)  yields 

^3i^  =  ^4^2  =  cot2abi(bi2s2aj3i  -  a^^)  (3.15) 
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Figure  3.22   Two  solutions  of  Gj-^-l  corresponding  to  r2  <  r  < 
r^  (aj_  =  10,  b^  =  5,  s^^^   =  0  and  aj^^  =  0  or  n) 
(circles  described  by  Bj_  and  Cj_  without 
translation  of  K\    are  coplanar) 
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Thus,  rij_,  r2i,  r3i  and  r4i  are  the  local  minima  or 
local  maxima  of  r  expressed  by  Eq.  (3.9).   In  order  to  find 
the  global  minimum  and  maximum  values,  we  take  the  second 
derivative  of  r  with  respect  to  9^1  of  Eq.  (3.10)^  which 
yields 


d^r 


dr 


+    (• 


'bi 


d0bj 


.)2      =      -bi[biS2abi(2c2et3i    -    i; 
aiCSbi] 


(3.16) 


At  the  position  of  local  minima  or  maxima,  the  first 
derivatives  equal  zero,  and  then 


d^r 


^bi' 


©bJ 


=  -bi(biS2abi  +  ai)  <  0       (3.17) 


d-^r 


d0b: 


©bi  =  ^ 


-bi(biS^ab3_  -  ai)  <  0 


3.1! 


At  the  position  of  r3  or  r^, 

i2. 


d'^r 


0bi 


arc  cos  ( 


biS'^abi 
s2abi 


>  0 


(3.19; 


According  to  Eqs.  (3.17)  -  (3.19),  r^^  and  r2i  are  local 
maxima,  and  r3j_  and  r^^   are  equal  local  minima  of  r.   Since 
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^li  ^  ^2i'  th^  global  maximum  is  ^n,    and  there  are  two 
equal  global  minima,  namely  r3j_  and  r43_.   The  exrernal  and 
internal  cylinders  of  the  subworkspace  are  then  the 
cylinders  of  radii  of  r]_j_  and  r^i'    respectively. 

Figure  3,23  shows  the  relationship  between  r  and  9]-|j_  in 
a  Cartesian  coordinate  system  in  this  case.   It  is  seen  that 
in  the  portion  of  the  subworkspace  where  r2j_  <  r  <  r^,    for 
a  given  position  of  point  Cj_,  which  implies  for  a  given 
value  of  r,  there  are  two  corresponding  solutions  of  Q-^j_. 
Thus  this  is  the  two-root  region  of  the  subworkspace.   The 
other  portion  of  the  subworkspace  is  the  four-root  region  of 
the  subworkspace  since  four  solutions  of  e\^j_   can  be  found  in 
that  region  for  a  given  translation  dj_  (see  Fig.  3.19)  and  a 
given  position  of  Cj_.   The  cylinder  of  radius  r  =  r2i  inside 
the  subworkspace  divides  the  subworkspace  into  a  two-root 
region  and  a  four-root  region,  and  the  surface  of  the 
cylinder  of  radius  r2i  itself  is  a  three-root  region.   It 
can  also  be  seen  that  the  external  boundary  (the  surface  of 
the  cylinder  of  radius  r  =  r^i)  is  a  one-root  region,  and 
the  internal  boundary  (the  surface  of  the  cylinder  of  radius 
r  =  r3j_)  is  a  two-root  region.   Since  the  offset  is  zero  and 
the  twist  angle  is  not  90°,  without  the  translation  of  Aj_ , 
the  locus  of  the  positions  of  point  Cj_  is  the  surface  of  a 
flattened  form  of  torus.   The  diametral  section  of  this  kind 
of  torus  is  shown  in  Fig.  3.24  and  the  root  regions  can  also 
be  visualized  easily  from  the  figure. 
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Figure  3.23   Two  solutions  of  @^^^   corresponding  to  r2  <  r  < 
r]_  and  four  solutions  of  Q^Q^   corresponding  to 
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Flattened  Form 


^2i(^A0 


10  0 

z^-axis 


Figure    3.24      Diametral   section   of    flattened   form  of   torus 


(ai   =    2,    bi 


10 


•bi 


0   and  a]3j_ 


Tl/3) 
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Furthermore,  in  the  case  when  a^  =  bj_s2aj-,j_,  the  roots 
of  9j-,^  of  Eq.  (3.12)  are  coincident  and  equal,  i.e.,  e^j_  = 
®^i  ~  ®ii  =  ^-   Thus,  r3j_  =  r4j_  =  r2i,  and  their  value  is 
the  minimum  of  r,  and  is  the  radius  of  the  internal  cylinder 
of  the  subworkspace. 

The  results  derived  are  illustrated  in  Figs.  3.25  - 
3.31,  where  the  projections  of  the  configurations  of  the 
subchain  are  presented. 

Figures  3.25  and  3.26  are  shown  for  the  case  of  a^^   -   0 
or  a,  i.e.,  Saj3,j_  =  0.   The  projection  of  the  circle 
generated  by  point  Cj_  on  the  Aj_Xiyj_  plane  is  also  a  circle. 
The  radii  of  the  external  and  internal  cylinders  of  the 
boundary  are  the  maximum  and  minimum  radii  r  of  the  torus. 
It  is  also  shown  that  the  subchain  can  take  two  branches 
for  point  Cj_  to  reach  the  same  position  in  the 
subworkspace,  illustrating  a  two-root  region. 

Figures  3.27  and  3.28  are  shown  as  the  case  of  aj-.^  #  0 
or  n  and  aj_  >  bj_s2aj3j^.   The  results  are  the  same  as  in  the 
case  shown  in  Figs.  3.25  and  3.26,  except  that  the 
projection  of  the  circle  of  point  Cj_  on  the  Aj_Xj_yj_  plane  is 
an  ellipse  now. 

Figures  3.29  and  3.30  are  shown  as  the  case  of  a]^^   ^   0 
or  Ti  and  aj_  <  bj_s2a]3j_.   The  internal  boundary  is  the 
cylinder  of  radius  r3j_.   The  circle  of  radius  r3j_  on  the 
plane  Oj_Xj_yj_  is  tangent  to  the  ellipse  at  two  points  showing 
the  values  of  r3j_  and  r4j_  (at  the  points  of  tangency)  ,  which 
are  both  the  equal  limiting  values  of  the  radius  r  of  the 
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Figure    3.25      Two-root   subworkspace   as   a]3j_   =   0   or   tx   and 
ai    >   bi 


Figure  3.25   Two-root  subworkspace  as  a}-|j_  =  0  or  n  and 


an  <  bn 
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Figure    3.27      Two-root   subworkspace   as   aj_    >   b.Ls2aj3J_    and 
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Figure    3.28      Two-root   subworkspace   as   a^    >   b3_s2abi   and 


99 


Figure  3.29   Two-root  subworkspace  as  a;  <  biS^au^  and 
r2  <  r  <  ri 
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Figure  3.30   Four-root  subworkspace  as  aj_  <  bj_s2a)3j_  and 
r3  <  r  <  r2 
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Figure    3.31      Two-root   subworkspace   as   aj_   =   bj_s2aj3j_ 
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torus.   In  Fig.  3.29,  the  subchain  can  take  two  branches  for 
point  Cj_  to  reach  a  certain  position  in  the  region  of  r2i  < 
r  <  r]_.L.   In  Fig.  3.30,  the  subchain  can  take  four  branches 
for  the  point  Cj_  to  reach  a  certain  position  in  the  region 
of  r3j_  (or  r4-i_)  <  r  <  r2i_-      These  figures  illustrate  that 
these  two  regions  are  the  two-root  and  four-root  regions  of 
the  subworkspace ,  respectively. 

Figure  3.31  describes  the  case  of  a^j_   ^    0   or   n,    and  aj_ 
=  bj_s2a]3,j_.   In  this  case,  the  circles  of  radii  r2i  and  r3.i_ 
(or  r4j_)  shown  in  Figs.  3.29  and  3.30  are  coincident.   Thus 
the  four-root  region  of  the  subworkspace  degenerates  to  a 
one-root  cylindrical  surface. 

Subworkspace  with  Offset  Sj-,j_  ^   0.   Taking  the 
derivative  of  both  sides  of  Eq.  (3.8)  with  respect  to  9j-,j_ 
and  letting  the  resulting  expression  equal  zero,  yields 

-S8bi(biC9bi  +  a^)  +  C8biCabi(biS9]3iCabi  -  SbiS^bi) 

=  0  (3.20) 

Expanding   sei3j_   and   C8]3J_   in   terms   of   tan-half -angle,    X  = 
tan(9i2i/2),    Eq.    (3.20)    can   be    rewritten   in   the    form  of    a 
quartic   equation   in  X: 

X4    +   BX3    +    CX2    +   DX    +    E    =    0  (3.21) 

where 

aj_   +   bj_(l    -    Caj3j_) 


B   =    4 


SbiS^cibi 
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C  =  0 

aj_  -  bj_(l  -  Caj3i) 


D  =  4 


E  =  1 


SbiS^CLbi 


Solving  the  quartic  equation  Eq.  (3.21),  we  can  obtain 
up  to  four  real  roots  for  X,  and  then  of  Q^^i.      Back 
substituting  the  roots  of  Q-^^    into  Eq.  (3,8),  up  to  four 
limiting  values  of  the  radius  r  of  the  torus  are  obtained. 

In  the  case  where  only  two  limiting  values  of  r  exist, 
one  is  the  maximum  Tj^^j^,  and  the  other  is  the  minimum  rj^j_j^ 
in  the  range  of  0  <  Q-^j_   <    2tx.   Hence  the  subworkspace  can 
be  expressed  as 

Xi2  +  y.2  <  ^2^^^  (3.22) 

and 

Xi^  +  Yi2  >  r2^i^  (3.23) 

In  the  case  where  four  limiting  values  of  r  exist,  we 
need  to  compare  the  four  values  and  find  the  maximum  and 
the  minimum  which  are  respectively  the  radii  of  the 
external  and  internal  cylinders  of  the  boundaries  of  the 
subworkspace . 

Furthermore,  the  relationship  between  r  and  ©bi ^  in 
the  two  cases,  are  shown  schematically  in  Figs.  3.32  and 
3.33  in  Cartesian  coordinate  systems,  respectively.   In  the 
first  case  (Fig.  3.32)  for  a  given  value  of  r  in  the  region 
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Figure  3.32   Schematics  showing  the  relationship  between  r 


and  9]-)j_  as  S]3J_ 
exist  as  a-;  =2, 


^    0. 


Two   limit   values   of    r 
-■    12,    a]3j_   =  Ti/6   and   Si3j_   = 
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Figure  3.33   Schematics  showing  the  relationship  between  r 
and  ev3j_  as  sj^j^  i^   0.   Four  limit  values  of  r 
exist  as  aj_  =  2,  bj_  =  12,  o.-<q^   -  ti/I.'d    and 
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^min  <  ^  <  ^max'  ^'"^°  corresponding  values  of  Q-^j_   are  found. 
Hence,  the  subworkspace  is  a  tv/o-root  region.   In  the  other 
case  (Fig.  3.33),  r  reaches  limiting  values  at  four 
positions  in  the  range  of  0  <  9j3j_  <  2k.      We  find  that  for 
given  values  of  r  in  the  region  of  r2  <  r  <  rj^^^'  1^3  <  r  < 
r2,  and  r^^^   <  r  <  r3,  the  numbers  of  corresponding  Q-^^   are 
two,  four  and  two,  respectively.   Hence  these  regions  in  the 
subworkspace  are  respectively  two-,  four-  and  two-root 
regions.   Since  these  involve  the  general  form  of  torus, 
the  diametral  sections  of  the  torus  are  shown  in  Figs. 
(3.34)  and  (3.35),  respectively.   The  root  regions  in  the 
subworkspace  can  also  be  visualized  easily  from  the 
figures. 

The  procedure  of  finding  the  root  regions  in  the 
subworkspace  can  be  summarized  as  shown  in  Fig.  (3.36). 

3 . 4   Conditions  for  No-Hole  Workspace 
Since  the  workspace  of  the  manipulator  is  the  common 
region  of  the  three  subworkspaces,  if  none  of  the 
subworkspaces  has  any  holes,  the  workspace  has  no  hole. 
Subworkspaces  in  general,  as  described  in  the  above 
sections,  have  cylindrical  internal  boundaries.   Under  some 
conditions  of  the  dimensions  of  the  manipulator,  the  radii 
of  the  internal  cylinders  are  zero.   Thus  the  internal 
boundaries  disappear  and  the  subworkspaces  have  no  hole. 
These  conditions  are  listed  in  Table  3.1. 
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General  Form 


Figure  3.34   Diametral  section  of  general  form  of  torus 
(aj_  =  2,  b.j_  =  12,  a]-)j_  =  tx/6  and  sj^^  =  8) 
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General  Form 


Figure  3.35   Diametral  section  of  general  form  of  torus 
(aj_  =  2,  b-i_  =  12,  aj-,j_  -   ti/2.5  and  sj^^^  =  8) 


109 


No 
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Figure  3.3  6   Procedure  of  finding  the  root  regions  in  the 
subworkspace  as  sj^^^^  =  0 
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Table  3 . 1   Conditions  for  No-Hole  Workspace 
(i  =  1,  2,  3) 


1              "n 
Case 

Radius  of  internal 
cylinder 

Condition  for 
no-hole 

^bi  =   0   or   n 

^2i^  =  (bi  -  ai)2 

bi  =  ai 

^bi  ^ 
0  or 

K 

ai  >  biS2abi 

ai  <  biS2abi 

^3i^  = 
cot2abi(bi2s2ai,i  -  3^2) 

a^i  =  ±  Ti/2 

, 

3 . 5  Workspace  of  the  Manipulator 
The  subworkspace  analysis  results  in  the  equations  of 
the  subworkspace  i  (i  =  1,  2,  3)  with  respect  to  the  local 
fixed  coordinate  system  Oj_Xj_yj_Zi.   Using  coordinate 
transformation  matrix  Ag^  from  the  global  fixed  system  OXYZ 
to  the  above-mentioned  system,  OiXiyiZ^,  we  transform  these 
equations  to  be  expressed  with  respect  to  the  global  system 
OXYZ. 


^gi 


(3.24) 


In  the  case,  for  example,  where  the  axes  of  the  three 
R-L  actuator  joints  are  arranged  in  equilateral  triangle 
form  on  the  base  as  shown  in  Fig.  3.37,  the  matrices  A^^    (i 
=  1,  2,  3)  are  as  follows: 


Ill 


Figure  3.37   Coordinate  systems  of  the  ground-mounted  R-L 
actuators  in  the  arrangement  of  equilateral 
triangle  form 
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^gi  " 


10  0      0 

0      1  0      h 

0      0  10 

0      0  0      1 


^g2 


^g3 


10  0  0 

0      cos(-120)  -sin(-120)  h 

0      sin(-120)  cos(-120)  0 

0                0  0  1 

10  0  0 

0      -1/2      73/2  h 

0      -73/2    -1/2  0 

0  0  0  1 

10  0  0 

0      cos(-240)  -sin(-240)  h 

0      sin(-240)  cos(-240)  0 

0                0  0  1 

10  0  0 

0      -1/2  -73/2  h 

0      yy/2  -1/2  0 

0         0  0  1 


With  the  substitution  of  these  matrices  into  Eq.  (3.24),  we 
obtain 
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xi  =  X 
Yl    =   Y   +    h 
Z]_  =  Z 

X2  =  X 

Y2  =  -(1/2)Y  +  (V3/2)Z  +  h 

Z2  =  -(y3/2)Y  -  (1/2)Z 

X3  =  X 

73  =  -{1/2)Y  -  (y3/2)Z  +  h 

Z3  =  (y3/2)Y  -  (1/2)Z 

Thus  the  equations  of  the  subworkspace  can  be  expressed 
as  follows: 

^Ei  =  Xi^  +  y^2  _  (a^  +  bi)2  <  0 
and 

Fli  =  Xi2  +  y. 2  _  rj. 2  >  0 

where  rjj_2  denotes  r2i2  or  r3-i_2  (see  Fig.  3.36),  can  be 
respectivelY  transformed  to  be  expressed  with  respect  to 
the  global  OXYZ  systera  as  follows: 

Fei  =  x2  +  (Y  +  h)2  -  (a.1    +   b^ )  2  <  0  (3.25) 

Fe2  =  x2  +  [-Y/2  +  (y3/2)Z  +  h]2  -  ( a^    +   b2 ) 2  <  0 

(3.26) 

Fe3  =  x2  +  [-Y/2  -  (v'^/2)Z  +  h]2  -  (a3  +  b3)2  <  0 

(3.27) 

^11  =  x2  +  (Y  +  h)2  -  rji^    >    0  (3.28) 
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Fj2  =  x2  +  [-Y/2  +  {v^/2)Z  +  h]2  -  r^2^    >    0       (3.29) 

Fi3  =  X2  +  [-Y/2  -  (y3/2)Z  +  h]2  -  r-^^^    >    0       (3.30) 

where  subscripts  E  and  I  denote  the  external  and  internal 
boundary,  respectively. 

The  workspace  of  the  platform  of  the  manipulator  with 
infinitesimal  platform  is  the  common  reachable  region  of  the 
three  subworkspaces.   Therefore  the  workspace  of  the 
manipulator  is  the  region  where  Eqs.  (3.25)  -  (3.30)  are 
satisfied  simultaneously. 

The  workspace  can  be  expressed  graphically  by  plotting 
the  cross  sections  of  the  workspace  on  the  planes  normal  to 
the  axes  of  the  system  OXYZ.   For  the  cross  sections,  Eqs. 
(3.25)  -  (3.27)  are  rewritten  respectively  as  follows: 

On  plane  OYZ,  X  =  constant 


Y  =   ±   J{a^+   bi)2    -   x2    -   h  (3.31) 
Y=(^)Z    +    2h+2    V(a2    +   b2 )  ^    -    x2  (3.32) 

Y  =   -(V3)Z   +    2h   +    2   V(a3    +   b3)2    -   x2  (3.33) 


On  plane  OZX,  Y  =  constant 


X  =  +  J(ai    +   bi)2  -  (Y  +  h)2  (3.34) 

X  =  ±  y(a2  +  b2)2  -  [-Y/2  +  (73/2)Z  +  h]2         (3.35) 

X  =  ±  y(a3  +  b3)2  -  [-Y/2  -  (73/2)Z  +  h]2         (3.36) 

On  plane  OXY,  Z  =  constant 


X  =  ±  V(ai  +  bi)2  -  (Y  +  h)2  (3.37) 
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X  =  ±  J(a2    +   b2)2  -  [-Y/2  +  (V3/2)Z  +  h]2         (3.38) 


X  =  ±  V(a3  +  b3)^  -  [-Y/2  -  (y3/2)Z  +  h]^         (3.39) 

Similarly,  Eqs.  (3.28)  -  (3.30)  can  be  rewritten  by  way  of 
replacing  the  terms  (a^  +  bj_)2  in  Eqs.  (3.31)  -  (3.39)  by 
rjj_2,  and  are  not  listed. 

Numerical  example.   The  given  parameters  are  as 
follows : 

a^  =  a2  =  a3  =  3",  b^  =  b2  =  b3  =  3" ,  h  =  2"  and  L  =  4" 

The  workspace  of  the  manipulator  is  the  common 
reachable  region  of  three  subworkspaces  determined  by  the 
corresponding  subchains.   We  thus  can  plot  the  cross  section 
of  the  workspace  on  the  plane,  say  OYZ ,  X  =  4,  plane,  which 
is  shown  in  Fig.  3.38.   There  are  three  pairs  of  parallel 
lines  which  denote  the  intersections  of  the  external 
boundaries  of  subchains  1,  2  and  3,  respectively,  with  the  X 
=  4  plane.   The  areas  between  those  parallel  lines  are  the 
intersections  of  the  workspaces  of  those  subchains  with  the 
X  =  4  plane.   It  is  noted  that  the  lengths  of  link  a  and  b 
are  equal,  the  radius  of  internal  cylinder  thus  is  zero,  and 
there  is  no  hole  in  the  subworkspace.   In  Fig.  3.39,  the 
cross  section  of  the  workspace  on  the  plane  OXY,  Z  =  0,  is 
shown.   The  contour  of  the  external  boundary  of  the  first 
subchain  is  a  half  circle  and  the  contours  of  the  second  and 
third  subchains  are  coincident  half  ellipses.   The  shaded 
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WORKSPACE  ISWIPi 

on   plane  OYZ,    X  =  4 


:  X 

-^^      \                / 

0**            \             / 

/             \//M/// 

////////// 

'\ 

w 

V////              ^El 

\               i 

<    0**      \ 

; •'■■■    — 1 ' 

1 ^,,      .,-}»_.,,       ,       .       1 

-» 


-2  0  2 

Z-axis   (inches) 


Figure  3.3  8  Workspace  of  the  manipulator  on  plane  OYZ  as 
X  =  4.  *SubWorkspace,  Infinitesimal  Platform. 
**See  Eqs.  (3.25)  -  (3.27)  . 
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WORKSPACE  iSWIP) 

on  plane  OXY,  Z  =  0 


- 

External  boundary 
of  subchain  1 

\ 

-             y"^^^         ~^ 

^r^x, 

■     /                ^I 

^^.  \ 

/            External  boundary       ^^ 
'  1              of  subchain  2(3)         ^ 

^1 

-6      -♦      -2       0       2       4       6 
Y-axis  (inches) 


Figure  3.3  9   Workspace  of  the  manipulator  on  plane  OXY  as 
Z  =  0.  *SubWorkspace,  Infinitesimal  Platform 
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area  is  the  intersection  of  the  workspace  of  the  manipulator 
with  infinitesimal  platform  with  plane  OXY,  Z  =  0. 

3 . 9   Summary 

A  general  approach  for  the  workspace  analysis  of  a 
parallel  manipulator  (shown  in  Fig.  3.1),  which  is  a  new 
area  to  be  developed,  has  been  presented  in  this  chapter, 
considering  the  platform  to  be  inf initesimally  small. 

In  order  to  get  the  workspace  of  the  manipulator,  the 
shapes  of  the  subworkspaces  are  illustrated  first,  then  the 
boundaries  of  the  subworkspaces  and  the  root  regions  in  the 
subworkspaces  are  determined. 

Different  combinations  of  joints  in  a  chain  create 
different  surfaces.   Torfason  and  Crossley  [52]  showed  the 
surfaces  generated  by  all  closed  spatial  pairs.   Jenkins, 
Crossley  and  Hunt  [53]  used  the  generated  surface  method  to 
analyze  the  gross  motion  of  the  generating  mechanism. 

According  to  the  equations  derived  in  this  chapter,  the 
workspace  of  the  manipulator  depends  on  the  length  of  the 
links,  twist  angles,  offsets  and  the  arrangements  of  the 
R-L  actuators  on  the  base  (Fig.  3.2).   As  to  the  design 
requirements,  the  methods  presented  may  help  decide  how  to 
choose  those  parameters  to  achieve  a  desired  workspace.   The 
ground-mounted  R-L  actuators  are  initially  assumed  to  have 
no  limits  on  translation  along  their  axes;  but  the  actually 
needed  maximum  translations  will  be  determined  by  the 
required  boundaries. 
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The  dimensions  of  the  end-ef f ectcr-carrying  platform, 
on  which  the  hand  is  mounted,  are  neglected  in  this  chapter 
in  order  that  the  workspace  of  this  type  of  parallel 
manipulator  be  more  readily  visualized  at  first.   In  Chapter 
4,  the  workspace  analysis  in  case  of  finite-size  platform 
will  be  discussed.   One  of  the  problems  that  will  be 
encountered  in  connection  with  the  workspace  is  the 
interference  between  the  links,  which  will  affect  the 
workspace.   This  is  regarded  as  a  subject  for  further  study. 


CHAPTER  4 
THE  WORKSPACE  OF  THE  MANIPULATOR  WITH  FINITE  SIZE  PLATFORM 


4 . 1   Introduction 

This  chapter  deals  with  the  workspace  determined  by  the 
geometric  method  which  was  developed  in  Chapter  3  as  well  as 
the  consideration  of  finite  size  platform  of  the 
manipulator.   The  lengths  from  the  center  of  the  platform, 
H,  to  the  centers  of  the  spherical  joints,  C]_,  C2  and  C3, 
affect  the  volume  of  the  workspace,  and  more  significantly, 
the  rotatability  of  the  platform  about  the  center  H.   Thus, 
to  get  a  workspace  of  the  manipulator  with  rotatability  of 
the  end  effector  as  large  as  possible,  the  lengths  between  H 
and  Cj_  (i  =  1,  2,  3)  should  be  as  small  as  possible, 
consistent  with  controllability  of  end-effector  orientation. 
When,  in  the  limit,  the  lengths  are  infinitesimal  or  zero, 
we  get  the  largest  theoretical  workspace  with  complete,  but 
uncontrollable  rotatability  of  the  platform. 

The  workspace  of  the  parallel  manipulator  is  defined 
here  as  the  region  within  which  every  point  can  be  reached 
by  the  center  of  the  platform,  H,  of  the  manipulator  (Fig. 
3.19).   The  volume  of  the  workspace  is  correlated  with  the 
orientation  and  the  rotatability  of  the  platform,  because  it 
is  often  important  for  a  designer  to  know  the  rotatability 
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of  the  platform  about  its  center  in  various  regions  of  the 
workspace. 

The  surface  where  the  platform  can  not  rotate  about  H 
in  any  direction,  when  the  center  H  is  on  that  surface,  is 
called  the  nonrotatability  surface  (NRS).   The  platform  thus 
cannot  assume  an  arbitrary  prescribed  orientation  when  H  is 
on  the  NRS.   The  complete  rotatability  workspace  (CRW) 
refers  to  the  workspace  within  which  or  on  whose  boundary 
the  platform  can  theoretically  rotate  in  any  direction.   The 
region  between  the  nonrotatability  surface  and  the  external 
boundary  of  the  complete  rotatability  workspace  can  be 
called  the  partial  rotatability  workspace  (PRW).   The 
contours  of  the  NRSS  and  CRSW  of  a  subchain  are  shown 
schematically  in  Fig.  4.1. 

4. 2  Workspace  of  the  Manipulator  with 
Infinitesimal  Platform 

The  workspace  of  the  parallel  manipulator  is  the  common 

region  of  the  three  subworkspaces  which  are,  respectively, 

the  reachable  regions  of  H,  determined  by  subchain  i  (i  =  1, 

2  or  3),  regardless  of  the  constraints  imposed  by  the  other 

two  subchains.   In  the  case  of  the  manipulator  with 

hypothetically  infinitesimal  platform,  point  H  is  coincident 

with  the  three  centers  of  the  spherical  joints,  Cj_  at  the 

corners  of  a  finite  size  platform.   The  subworkspace  of 

infinitesimal  platform  (SWIP)  contains  the  reachable  region 

of  point  Cj_.   Symbolically,  they  can  be  expressed  in  the 

form  of  the  following  inequalities: 
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NRSS  ( NonRotatability 
Subsurface) 


External  boundary  of 
SWIP  (SubWorkspace, 
InfinitesimEil  Platform) 


External  boundary  of  CRSW 
(Complete  RotatabUity 
SubWorkspace) 


ii> 


yai 


Figure  4.1   The  relationships  between  the  external 

boundaries  of  CRSW  and  NRSS  of  subchain  i 
ai  =  bi  (i  =  1,  2  and  3) 
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FEi(Xni,  Yj^,  Z^)    <    0  (4.1) 

Fli(Xn,,  Y^,  Z^)    >    0  (4.2) 

Here  the  subscripts  E  and  I  denote  respectively  the  external 
and  internal  boundaries.   For  distinction  of  the  coordinates 
of  the  points  on  the  boundaries  of  SWIP  ( SubWorlcspace, 
Infinitesimal  Platform)  from  those  of  the  points  inside  the 
subworkspace  of  H,  we  use  X^,    Y^   and  Z^  to  denote  the 
coordinates  derived  in  Chapter  3  for  infinitesimal  platform, 
and  X,  Y  and  Z  are  used  in  the  following  sections  to  denote 
the  coordinates  when  a  finite  size  platform  is  considered. 
The  boundaries  of  the  SWIP  can  then  be  respectively 
expressed  symbolically  by  the  corresponding  equalities  as 

FEi(Xm,  Y^,  Z^)    =    0  (4.3) 

Fli(Xm,  Yj^,  Z^)    =   0  (4.4) 

4.3   The  Complete  Rotatability  Workspace  (CRW)  and 
the  Partial  Rotatability  Workspace  (PRW) 

The  platform  can  rotate  about  point  C^   describing  a 

whole  sphere  as  the  locus  of  point  H,  if  we  disregard  link 

interferences  and  the  constraints  imposed  by  the  other  two 

subchains,  even  when  point  Cj_  is  already  on  the  external 

boundary  of  the  i-th  SWIP.   This  situation,  with  the  finite 

dimensions  of  the  platform,  is  depicted  in  Fig.  4.2,  where 

Cj_  are  at  the  vertices  of  an  equilateral  triangle  with  H  at 
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0      PEi(Xm.    Yjn,    Z^)   =  0 


external  boundary 
of  the  i-th  SWIP) 


Figure    4.2      Rotatability  of    the    finite   size   platfc 
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its  geometric  center.   Considering  point  H  as  the  center  of 
the  rotation  of  the  platform,  however,  the  platform  can 
usually  rotate  about  it  only  in  a  portion  of  a  sphere.   The 
platform  can  rotate  about  H  only  in  such  a  direction  that 
the  angle  a  between  the  velocity  of  point  C.j_  moving  with  the 
rotating  platform  and  the  gradient  VF^^^,  which  points 
towards  the  outside  of  the  SWIP,  is  greater  than  n./2.   When 
the  platform  rotates  so  that  HCj_  approaches  the  direction  of 
the  gradient,  then  Cj_  moves  inside  the  SWIP.   Therefore,  it 
does  not  prevent  the  platform  from  rotating.   But  in  the 
opposite  direction,  Cj_   would  move  outside  the  SWIP,  and 
therefore,  it  prevents  the  platform  from  rotating.   This 
means  that  at  this  position  of  H,  the  platform  has  partial 
rotatability  about  the  center  H. 

Referring  to  Fig.  4.2,  let  Ej_q   denote  the  point  which 
is  on  the  internal  extension  of  the  line  of  the  gradient 
^^Ei'  ^^"^  ^^^  distance  from  Hj^q  to  the  boundary  equals  the 
length  of  C^H  of  the  platform.   The  sense  of  Cj_Hj_c  is 
opposite  to  that  of  the  gradient.   If  the  point  H  takes  the 
place  of  Hj_Q,  the  instantaneous  velocity  of  Cj_,  when  the 
platform  starts  to  rotate  in  any  arbitrary  direction,  is 
perpendicular  to  VFgj^.   In  this  case  point  Cj_  moves  either 
on  the  boundary  or  toward  the  inside  of  the  SWIP. 
Disregarding  link  interference,  the  subchain  i  does  not 
prevent  the  platform  from  rotating  about  point  H,  and 
therefore,  the  platform  is  said  to  have  complete 
rotatability,  so  far  as  the  i-th  subchain  is  concerned.   The 
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locus  of  all  points  E^q   constitutes  the  external  boundary  of 
the  so  called  complete  rotatability  subworkspace  (CRSW) 
determined  by  the  subchain  i.   The  CRW  (Complete 
Rotatability  Workspace)  of  the  manipulator  is  the  common 
region  of  the  three  CRSWs.   Moreover,  let  us  consider  the 
other  point  E^^   on  the  line  of  the  gradient  VFgj^,  and  with 
the  same  distance  outside  of  the  boundary  as  Ej^q   on  the 
inside.   The  sense  of  C^.j_f|  is  the  same  as  that  of  the 
gradient.   One  can  easily  verify  that  the  locus  of  these 
Hj_j^  points  constitutes  the  so-called  nonrotatability 
subsurface  (NRSS).   The  region  between  the  CRSW  and  NRSS  is 
called  the  partial  rotatability  subworkspace  (PRSW).   After 
the  three  PRSWs  of  each  of  the  three  subchains  have  been 
obtained,  one  can  find  the  manipulator's  PRW  (Partial 
Rotatability  Workspace)  as  the  common  regions  of  the  three 
PRSWs . 

It  should  be  noticed  that  for  the  complete  rotatability 
subworkspace  to  exist,  the  short  principal  radius  of 
curvature  of  the  surface  of  the  external  boundary  should  be 
longer  than  L,  the  length  of  C~H  of  the  platform.   Otherwise 
the  arc  drawn  by  point  C^   centered  at  E^q   is  on  the  outside 
of  the  SWIP  as  shown  in  Fig.  4.3,  and  therefore,  point  Cj_ 
would  prevent  the  platform  from  rotating  about  H.   For  the 
manipulator  with  the  R-L  actuators  with  offset  s^^   =  0,  the 
external  boundary  of  the  SWIP  is  the  cylinder  of  radius 
(aj_  +  bj_)  (see  Fig.  3.21).   Since  the  short  principal  radius 
of  curvature  of  a  cylinder  is  the  radius  of  the  cylinder 
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(external  boundary 
of  the  i-th  SWIP) 


Figure    4.3      Radius   of   curvature   of   the   external   boundary  of 
SWIP    (SubWorkspace,    Infinitesimal   Platform) 
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itself,  it  is  important  to  design  the  manipulator  so  that 
the  condition  aj_  +  bj_  >  L  be  satisfied.   Otherwise,  the 
complete  rotatability  subworkspace  does  not  exist.   In  fact, 
to  make  the  CRSW  as  large  as  possible,  the  length  of  Cj_H, 
and  thus  the  size  of  the  platform,  ought  to  be  as  small  as 
possible.   Mathematically,  the  coordinates  of  the  point  on 
the  CRSW  and  the  NRSS  can  be  expressed  respectively  as 


and 


-i  (CRSW) 


(NRSS) 


r-                          -1 

Xm 

Ym 

2m 

Y^Ei 


lY^Eil 


Y^Ei 


lY^Eil 


(4.5) 


(4.6) 


Generally  the  simultaneous  solution  of  Eqs.  (4.5)  and 
(4.3)  represents  the  equation  of  the  external  boundary  of 
the  CRSW,  and  the  simultaneous  solution  of  the  Eqs.  (4.6) 
and  (4.3)  represents  the  equation  of  the  NRSS,  where  both 


For  obtaining  the  implicit  equations  of  the  boundaries  of 
the  CRSW  and  NRSS  correlating  X,  Y  and  Z,  one  can  derive  the 
expressions  of  Xj^,  Y^^  and  Z^^  in  terms  of  X,  Y  and  Z  from 
Eqs.  (4.5)  and  (4.6),  respectively,  and  then  substitute  the 
resulting  expressions  into  Eq.  (4.3). 
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For  the  manipulator  shown  in  Fig.  3.19  and  with  the 
base  arrangement  in  equilateral  triangle  form  (see  Fig. 
3.37),  Eqs.  (4.3)  for  subchains  1,  2  and  3  have  the 
following  forms  (see  Eq.  (3.25)  -  (3.27)) 


^El  =  ^m^  +  <Yn,  +  h)2  -  (ai  +  bi)2  =  0  (4.7) 

Fe2  =  ^m^   +  (-Ym/2  +  V3Zj^/2  +  h)2  -  (a2  +  b2 )  2  =  0 


(4.8) 


E3  -  ^ra 


Xm2  +  (-Yr^/2  -  y3Zm/2  +  h)2  -  (a^  +  b^  )  2  =  0 


(4.9) 


We  now  calculate  the  gradient  of  the  first  equation  Fg]_  =  0, 
VFei  as 


Y^El 


3FEl/9Xni 
3Fei/3Y^ 
SFei/3Zj^ 


2X, 


(4.10) 


IVFeiI    =   y    OFEi/3Xn,)2    +    (3Fei/cYj^)2    +    (5Fei/9Zj^)2 


2    y  Xn,2    +    (Y^   +   h)2 


2(ai   +  bi 


(4.11) 


Substituting  expressions  (4.10)  and  (4.11)  into  Eq.  (4.5), 
we  obtain 


Y  =  Y„ 


Z  =  Z, 


ai  +  bi 


(Y^  +  h)L 


ai  +  bi 


(4.12) 

(4.13) 
(4.14) 
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Solving  Eq.  (4.12)  -  (4.14)  for  Xj^,  Y,^  and  Z^  in  terms  of  X, 
Y  and  Z  yields 


X(ai  +  bi  ) 
(4.15 


a]_  +  b2_  -  L 
Y(ai  +  b^)  +  hL 


(4.16) 


bi  -  L 


Zm  =  Z  (4.17) 

Finally,  substituting  expressions  (4.15)  -  (4.17)  into  Eq. 
(4.7)  yields  the  equation  of  the  external  boundary  of  the 
CRSW  of  the  first  subchain  as 


'ECl 


=  x2  +  (Y  +  h)2  -  (ai  +  bi  -  L)2  =  0        (4.18: 


where  the  subscript  C  denotes  complete  rotatability. 

Similarly,  the  equations  of  the  external  boundaries  of 
the  CRSW  of  the  second  and  third  subchains  are  found  to  be 
as  follows: 


^EC2  =  x2  +  (-Y/2  +  y3Z/2  +  h)2  -  (a2  +   ^2    ~    ^^^  =  ° 

(4.19) 

Fec3  =  x2  +  (-Y/2  -  y3Z/2  +  h)2  -  (a3  +  b3  -  L) 2  =  0 

(4.20) 


In  fact,  the  SWIP  represented  by  Eq.  (4.3)  is  a 
cylinder  of  radius  (a3_  +  b-j_ )  ,  and  the  CRSW  is  a  coaxial 
cylinder  of  radius  (aj_  +  b.i_  -  L).   Therefore  one  can  easily 
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write  Eqs.  (4.21)  -  (4.23)  for  the  NRSS  ( NonRotatability 
Subsurface)  directly  by  referring  to  Eqs.  (4.18  -  4.20)  as 
follows : 

^SNl  =  X2  +  (Y  +  h)2  -  (a^  +  bi  +  L)2  =  0         (4.21) 

FSN2  =  X2  +  (-Y/2  +  y3Z/2  +  h)2  -  (3,^    +  ^^  +  L)2  =  0 

(4.22) 

^SNS  =  X2  +  (-Y/2  -  y3Z/2  +  h)2  -  (33  +  bj  +  L)  2  =  0 

(4.23) 

where  the  subscripts  S  and  N  denote  surface  and 
nonrotatability,  respectively. 

Then  we  can  obtain  the  external  boundaries  of  the  CRW 
of  the  manipulator  by  solving  Eqs.  (4.18)  -  (4.20) 
simultaneously.   The  PRW  (Partial  Rotatability  Workspace) 
can  be  obtained  as  the  following  inequalities  are  satisfied: 

FEci(X,  Y,  Z)  >  0  (4.24) 

and 

FsNi(X,  Y,  Z)  <  0  (4.25) 

where  i  =  1,  2  and  3. 

The  equations  of  the  internal  boundary  of  the  CRSW  of 
subchains  1,  2,  and  3,  which  can  be  derived  in  a  similar 
way,  are  expressed  as  follows: 


^ICl  =  x2  +  (Y  +  h)2  -  (r^i  +  L)2  >  0 


(4.26) 
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Fjci    =  x2  +  [-Y/2  +  {J3/2)Z   +   h]2  -  (rji  +  L)2  >  0 

(4.27) 

FrpT  =  x2  +  [-Y/2  -  (y3/2)Z  +  h]2  -  (rji  +  L)2  >  0 

(4.28) 


where  rj.i_  denotes  r2i  or  r3j_  (see  Fig.  3.36)  and  i  =  1,  2 
and  3.   Once  the  internal  boundaries  of  the  three  CRSWs  have 
been  obtained,  the  internal  boundary  of  the  CRW  can  be  found 
as  the  common  areas  of  the  three  CRSWs. 

Numerical  example.   The  given  parameters  are  as 
follows: 

ai  =  a2  =  a3  =  3",  b^  =  b2  =  b3  =  3" ,  h  =  2" ,  L  =  1" 
and  X  =  4" 

In  Fig.  4.4,  a  cross  section  of  the  workspace  of  the 
manipulator  is  plotted  on  the  plane  OYZ,  with  X  =  4.   It  is 
noticed  that  the  complete  rotatability  workspace  is  very 
limited  for  this  kind  of  manipulator,  especially  when  the 
size  of  the  platform  is  not  small  compared  to  the  length  of 
the  links. 

4. 4   The  Workspace  of  the  Platform  with 
Given  Orientation 

The  workspace  of  the  platform  with  given  orientation  on 

a  plane  is  defined  here  as  the  reachable  region  on  a  plane 

of  the  center  H  of  the  platform,  while  the  platform  keeps 

moving  with  a  given  orientation.   The  simplest  case  is  that 

the  plane  is  perpendicular  to  one  of  the  coordinate  axes,  X, 
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WORKSPACE  (CRWl 

on  plane  OYZ,  X  = 


-2    0     2 
Z-axis  (inches) 


Figure  4.4   Complete  rotatability  workspace  of  the 
manipulator  on  plane  OYZ,  with  X  =  4 
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Y  or  Z  of  the  fixed  global  system.  All  the  points  Cj_  are  in 
that  same  plane. 

When  the  point  C.i_  of  subchain  i  is  on  the  intersection 
of  the  boundary  of  the  SWIP  with  the  plane,  which  plane  is, 
for  example,  perpendicular  to  the  X  axis  as  shown  in  Fig. 
4.5,  the  platform  can  rotate  in  the  plane  about  the  axis 
through  H  and  normal  to  the  plane  in  a  portion  of  a  circle. 
The  platform  can  rotate  only  in  such  a  direction  that  the 
point  Cj_  moves  inside  the  SWIP. 

In  general,  the  intersection  of  the  SWIP  with  the  plane 
are  lines.   They  can  be  symbolically  expressed  as 

FEi^'^Xj^'  Y^'  Zm)  =  0  (4.29) 

and 

Xj^  =  d  (4.30) 

where  the  superscript  x  denotes  the  normal  of  the  plane,  the 
subscript  E  implies  the  external  boundary,  d  is  a  constant 
distance  from  the  origin  and  i  =  1,  2  and  3.   Since  the 
procedures  of  the  analysis  for  the  external  and  internal 
boundaries  are  similar  to  each  other,  we  discuss  only 
positions  on  the  external  boundary  in  the  following  section. 
The  workspace  inside  the  external  boundary  is  expressed  by 
inequality  (one  for  each  subchain): 

FEi^(Xm'  Y^'  2m)  <  0,  i  =  1,  2,  3  (4.31) 
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^EiCXm,  Y^,  z^)  =  0 


%(Xm.  Y^,  Z„)  =  0 


Figure  4.5   Schematic  drawing  of  the  positions  of  points 

^ic  ^nd  Hj_i^  when  the  platform  keeps  moving  in  a 
plane  perpendicular  to  the  X  axis  of  the  global 
coordinate  system  (no  scale) 
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The  gradient  of  Fgj_^  can  be  expressed  as  follow: 

VFEi^  =  [0'  i^FEi>^/5Yj^'  3FEi^/52j^]^  (4.32) 

and  points  toward  the  outside  of  the  boundary. 

Let  Ej_Q   and  H.j_j^  be  the  points  on  the  line  of  the 
gradient  such  that  the  distance  from  these  two  points  to 
the  boundary  is  L  (the  same  as  Cj_H)  ,  and  the  sense  of  C.j_Hj_q 
is  opposite  to  that  of  the  gradient  and  the  sense  of  Cj_Hj_f^ 
is  the  same  as  that  of  gradient.   It  is  seen  that  when  the 
center  H  takes  the  position  of  Hj_(-.,  the  platform  reaches  a 
limiting  position  in  the  direction  of  the  gradient  with 
complete  rotatability  about  H,  provided  we  disregard  link 
interference  and  the  constraints  imposed  by  the  other  two 
subchains.   This  means  that  the  locus  of  points  Rj_q 
constitutes  the  external  boundary  of  the  CRSW  with  the 
platform  remaining  in  the  given  plane.   Similarly,  one  can 
see  that  the  locus  of  points  Hj_j^  constitutes  the 
intersection  of  the  NRSS  with  the  plane. 

The  coordinates  of  the  points  Hj_q  and  Hj_j^  when  H  is  on 
the  plane  can  be  expressed  by  Eq.  (4.5)  and  (4.6)  with  X  = 
d.   The  simultaneous  solution  of  Eqs.  (4.5)  and  (4.29), 
therefore,  represents  the  intersection  of  the  external 
boundary  of  the  CRSW  with  the  plane  X  =  d,  and  the 
simultaneous  solution  of  Eqs.  (4.6)  and  (4.29)  represents 
the  intersection  of  the  NRSS  with  the  plane  X  =  d.   Having 
the  equations  of  the  intersection  lines  of  the  boundaries  of 
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the  three  CRSWs  and  the  three  NRSSs  of  the  three  subchains 
with  the  plane  X  =  d,  the  intersections  of  the  CRW  and  PRW 
of  the  manipulator  with  the  plane  X  =  d  are  the  common 
regions  of  the  former  intersections. 

For  the  manipulator  shown  in  Fig.  3.19  and,  with  the 
base  arrangement  in  equilateral  triangle  form  (Fig.  3.37), 
for  example,  the  intersection  of  the  SWIP  determined  by  the 
first  subchain  with  the  YZ  plane  (X  =  d)  is  described  as 
(see  Eq.  3.31) 


r.  .  .2 


Yj^  =  -h  ±  V(ai  +  bi)'^  -  Xf^^  (4.33) 

where  X^,  is  a  constant,  and  therefore  this  equation 
represents  two  straight  lines  parallel  to  the  Z  axis.   To 
express  the  subworkspace,  Eq.  (4.33)  ought  to  be  written 
individually  for  these  two  lines,  two  branches  of  the 
intersections  of  the  boundary  with  plane  X  =  constant,  as 


and 


^El'^'^^m'    '^mr    2m)  =  Yn,  +  h  -  Jia^   +  bi )  2  -  x^^    <    0 

(4.34) 


Fei^(X^,  Yj^,  Z^)    =    -(Y^  +  h)  -  VUi  +  bi)2  -  Xj^2  <  0 

(4.35) 

The  gradients  of  the  two  half-planes  defined  by  these 
two  inequalities  are 


VFei^  =  (0,  1,  0)i  (4.36) 

and 

VFei^  =  (0.  -1.  0)T  (4.37) 
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Substituting  the  expressions  (4.36)  and  (4.37)  into  Eq. 
(4.5),  the  boundary  of  the  CRW  becomes  these  two  lines: 


(4.38) 


A 

^m 

Y 

= 

Ym  -   L 

Z 

= 

2m 

and 

X 

= 

Xm 

Y 

= 

Ym  +   L 

Z 

= 

Zm 

(4.39; 


Furthermore,  substituting  Eqs.  (4.38)  and  (4.39)  into 
(4.34)  and  (4.35)  respectively,  we  obtain  the  two 
corresponding  lines  of  the  intersections  of  the  CRSW  with 
the  plane  X  =  constant  expressed  in  X,  Y  and  Z  as 


Y  +  L  +  h  -  J{ai   +   bi)2  -  x2  <  0  (4.40 

and 


-(Y  -  L  +  h)  -  J(ai    +   bi)2  -  x2  <  0  (4.41) 

where  X  is  a  constant. 

The  intersection  with  the  plane  can  be  expressed  in  one 
equation  which  has  a  form  similar  to  Eq.  (4.33)  as 


Y  =  -h  +  JUi   +   bi)2  -  x2  +  (-L)  (4.42) 

where  X  is  a  constant  and  therefore  Eq.  (4.42)  also 
represents  two  straight  lines  parallel  to  the  Z  axis. 
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Similarly,  the  equations  of  the  external  boundaries  of 
the  CRSW  of  the  second  and  third  subchains  are  found  to  be 
as  follows: 

Fe2c^  =  x2  +  (-Y/2  +  V3Z/2  +  h  +  L)2  -  (^2    +   b2 ) 2  =  0 

(4.43) 
Fe3c^  =  x2  +  (-Y/2  -  y3Z/2  +  h  +  L)2  -  (33  +  b3 ) 2  =  Q 

(4.44) 
Numerical  example.   The  given  parameters  are  as 

follows: 

^1=^2=^3=  3",  bi  =  b2  =  b3  =  3",  h  =  2",  L  =  1" 
and  X  =  4" 

In  Fig.  4.6,  a  cross  section  of  the  workspace  of  the 
manipulator  is  plotted  on  the  plane  X  =  4.   It  is  noticed 
that  the  complete  rotatability  workspace  is  larger  than  the 
cross  section  of  the  workspace  as  shown  in  Fig.  4.4. 
However,  the  cross  section  of  the  workspace  of  the 
manipulator  is  still  very  limited. 

The  equations  for  the  NRSSs  determined  by  the 
corresponding  subchains  can  be  derived  in  a  similar  way  and 
are  therefore  not  described  here. 

The  foregoing  discussion  applies  to  the  case  where  the 
given  plane  is  perpendicular  to  one  of  the  axes  of  the 
global  coordinate  system.   In  a  general  case,  where  the 
plane  is  inclined  to  the  axes  of  the  system,  the  gradient  of 
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Figure    4.6      Complete   rotatability  workspace   of   the 
manipulator   on  plane  X  =   4 
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the  intersection  of  the  SWIP  with  the  given  plane  can  be 
obtained  by  coordinate  transformation. 

The  given  plane  can  be  specified  by  its  normal  N  and 
the  shortest  distance  to  the  plane  from  the  origin  of  the 
global  system,  d.   We  can  set  a  new  reference  system  Oxyz 
with  the  X  axis  coincident  with  the  normal  of  the  plane,  and 
with  the  origin  coincident  with  the  origin  of  the  old  system 
as  shown  in  Fig.  4.7.   The  axis  y  is  set  to  be  perpendicular 
to  both  the  axis  X  of  the  old  system  and  the  normal.   Let  n, 
r,  and  s  now  be  unit  vectors  on  the  three  new  axes  of  x,  y 
and  z,  respectively.   The  unit  vector  n  is  given  as 

n  =  (nx,  nv,  n^)T 


Then 


r  =  1  X  n  = 


1  J  k 
10  0 
n^  n,,  nr 


(0,  -n„,  nv) 


=  (n. 


'X^iy, 


■n^n~) 


The  transformation  matrix  from  the  new  system  to  the 
old  one  can  be  written  as 
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)  =  0 


Figure  4.7   The  positions  of  points  H^^  and  H^^   when  the 

platform  keeps  moving  in  a  plane  inclined  to  the 
axes  of  the  global  coordinate  system 
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the  equation  of  the  boundary  of  the  SWIP  originally 
expressed  with  respect  to  the  global  system  OXYZ  can  be 
transformed  to  be  expressed  with  respect  to  the  new  system 
Oxyz.   For  example,   Eq.  (4.7)  of  the  external  boundary  of 
the  SWIP  of  the  first  subchain  can  be  transformed  to  be 
expressed  with  respect  to  the  new  system  as 

FeI  =  tXj^n^  +  Zj^(ny2  +  n22)]2  +  ^x^^ny  -  Y^^n^  - 

Zj^n^n^  +  h]2  -  (ai  +  bi)2  =  0  (4.45) 


where  X^  is  a  constant. 

Eq.  (4.45)  represents  the  intersection  of  the  boundary 
with  the  given  plane  with  respect  to  the  new  system  Oxyz. 
In  the  above  equations  the  subscript  m  denotes  that  the 
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corresponding  coordinates  are  of  the  point  on  the  SWIP.   The 
gradient  of  the  intersection  expressed  with  respect  to  the 
new  system  can  be  obtained  as 

VFei^  =  (0,  3FEi/3Yn,,  5Fei/3Zj^)  (4.46) 

where  the  superscript  n  denotes  that  the  gradient  is  on  the 
plane  whose  normal  is  N,  and  from  Eq.  (4.45)  one  can  obtain 

3Fei/SYj^  =  2(Xn,ny  -  Y^n^  -  Z^^n^^n^  +  h)(-n2)       (4.47) 
and 


2(Xniny  -  Y^n^    -    Zi^n^n^  +  h)(-nxn2)     (4, 

Let  Gy  and  G^  denote  respectively  ^Fei/9Yj^  and  SFei/SZj^ 
expressed  by  Eqs.  (4.47)  and  (4.48).   Then  we  can  obtain 


48) 


IVFei^I  =  V  Gy2  +  0^2  (4.49) 

Substituting  Eqs.  (4.46),  (4.47),  (4.48)  and  (4.49) 
into  Eq.  (4.5),  we  obtain  the  coordinates  of  point  H^^^,  the 
limiting  position  of  point  H  where  the  platform  has  complete 
rotatability  in  the  given  plane,  as  follows: 

X  =  X^  (4.50) 


y  =  Y^  -  GyL/VGy2  +  G^^  (4.51) 


z    =    Z^    -    G^L/Jg^^    +   G  2 
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(4.52) 


The  simultaneous  solution  of  Eqs .  (4.50)  -  (4.52)  and 
(4.45)  represents  the  equation  of  the  external  boundary  of 
the  CRSW  of  the  first  subchain  on  the  plane,  correlating  Yj^ 
and  Zj^  expressed  in  the  new  system  Oxyz. 

Finally  we  can  use  the  inverse  transformation  A"l 


-1 


and  transform  the  coordinates  of  the  point  on  the  boundary 
defined  by  Eq.  (4.50)  -  (4.52)  combined  with  Eq.  (4.45)  to 
be  expressed  with  respect  to  the  global  system  OXYZ. 

That  is  the  method  of  transforming  the  SWIP  in  the 
plane  to  be  expressed  with  respect  to  a  new  reference  where 
the  given  plane  is  perpendicular  to  one  of  the  axes.   Then 
in  the  new  reference  the  gradient  of  the  boundary  in  the 
given  plane  and  the  coordinates  of  the  point  on  the  CRSW  or 
NRSS  are  respectively  calculated.   Finally,  the  results  are 
transformed  bac)c  to  be  expressed  with  respect  to  the  global 
system  using  inverse  transformation.   This  procedure  will  be 
taken  for  the  three  subworlcspaces  with  complete  rotatability 
or  nonrotatability  of  the  platform,  and  the  corresponding 
workspace  of  the  manipulator  is  obtained  as  the  common 
region  of  these  three  subworkspaces . 
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4 .  5   Suirmnary 

Two  sorts  of  the  workspace,  the  complete  rotatability 
workspace  (CRW)  and  partial  rotatability  workspace  (PRW),  of 
the  parallel  manipulator  with  finite  size  platform  are 
studied  in  this  chapter.   The  nonrotatability  surface  (NRS) 
and  the  boundaries  of  the  complete  rotatability  workspace 
are  parallel  to  the  boundary  of  the  workspace  of  the 
manipulator  with  infinitesimal  platform  (WIP).   The  complete 
rotatability  workspace  is  inside,  and  the  nonrotatability 
surface  is  outside  of  the  WIP. 

The  cross  sections  of  the  CRW  of  the  manipulator  are 
plotted  on  the  plane  OYZ,  with  X  =  constant  and  on  the 
plane,  X  =  constant,  where  the  platform  can  only  move 
around,  respectively.   The  workspace  of  this  type  of 
manipulator  is  limited. 

For  a  workspace  with  complete  rotatability  to  be  as 
large  as  possible,  the  size  of  the  platform  should  be  as 
small  as  possible.   For  a  large  partial  rotatability 
workspace,  the  size  of  the  platform  should  be  as  large  as 
possible. 


CHAPTER  5 
MECHANICAL  ERROR  ANALYSIS  OF  THE  MANIPULATOR 


5. 1   Introduction 

In  the  control  of  robotic  manipulators,  the  primary 
task  is  to  drive  the  links  to  their  desired  positions 
corresponding  to  a  given  input.   Actuators  are  the  devices 
that  make  the  robot  move.   The  mechanical  error  is  defined 
as  the  minor  inaccuracies  in  displacements  (translation  and 
rotation)  of  the  actuators  for  a  certain  specified  hand 
position.   In  order  to  increase  the  accuracy  of  the  desired 
hand  position,  we  must  reduce  all  errors  as  far  as  possible. 

In  this  chapter,  a  six-degree-of -freedom  parallel 
manipulator  with  ground-mounted  actuators,  as  shown  in  Fig. 
3.1,  has  been  studied  from  the  viewpoint  of  mechanical 
error  analysis.   Ground-mounted  actuators  in  parallel 
manipulators  avoid  the  dynamic  errors  caused  in  serial 
manipulators  by  those  actuators  mounted  on  the  movable 
links,  away  from  the  ground.   Therefore,  the  mechanical 
errors  of  parallel  manipulators  with  ground-mounted 
actuators  are  due  to  the  input  angle  and  translation  errors 
of  the  actuators,  if  the  tolerances  of  the  link  lengths  are 
not  considered.   In  the  study  of  position  and  orientation  of 
the  hand  (end-effector)  embedded  in  the  platform,  we  may  use 
inverse  kinematics  to  transform  the  pose  (position  and 
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orientation)  of  the  hand  to  a  global  coordinate  system  by 
homogeneous  transformation  matrices.   The  determination  of 
joint  velocities  using  screws,  presented  by  Mohamed  and 
Duffy  [46]  and  Sugimoto  [47],  is  adapted  in  this  chapter  to 
describe  the  velocities  and  small  displacements. 

With  consideration  of  input  errors  as  differential 
motions,  we  will  obtain  the  corresponding  error  movement  of 
the  platform,  in  which  the  hand  is  embedded,  due  to  the 
inaccuracies  of  the  actuators. 

5. 2   Position  Analysis 
A  subchain  of  a  six-degree-of -freedom  parallel 
manipulator,  where  all  the  actuators  are  ground-mounted,  is 
shown  schematically  in  Fig.  5.1.   Let  H  denote  the  position 
vector  of  the  hand  which  is  embedded  on  the  platform,  and 
1,  m  and  n  denote  the  unit  vectors  describing  the  hand 
orientation  of  the  moving  system.   By  using  homogeneous 
transformation,  we  can  describe  the  relative  position  and 
orientation  between  any  two  coordinate  frames.   Therefore, 
we  can  '. 
follow: 


(5.1) 
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Figure  5.1   The  i-th  subchain  of  the  manipulator,  with  R-L 
actuator  at  A^ 
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where  lj_,  mj_  and  nj^  are  the  components  of  the  basis  unit 
vectors  of  the  hand  coordinate  system,  H^  are  the 
components  of  the  hand  position  vector  and  i  =  x,  y  and  z. 
The  position  vector  of  point  Cj_   with  respect  to  OXYZ  then 
can  be  calculated  from  the  following  equation: 


■P 


(5.2) 


where  ^(HCj^)  denotes  the  vector  HCj_  with  respect  to  the 
moving  coordinate  system  Hxyz.   We  can  also  find  another 
coordinate  transformation  matrix  Tj^,  from  Oj_x.i_y-j_Zj_  to  OXYZ, 
which  can  be  expressed  as 


Ti  = 


^ix   ^ix 


OO-i 


'ly 


Yiz 
0 


■ly 


Oo 


ly 


OO-i 


(5.3 


According  to  the  relationship  between  the  coordinate 
systems,  we  can  have  the  following  equations: 


5.4) 


(Ti)-l°Ci 


(5.5) 


where 


(Ti) 


1  _ 


Xiy 

^iz 

-OOi 

•  ^i 

Yiy 

Yiz 

-OOi 

•  Yi 

2iy 

ziz 

-OOi 

z^ 

0 

0 

1 

(5.6) 
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and  Xj_,  Yi  and  Zj_  are  unit  vectors  along  the  axes  of 
°i^iYiZi- 

The  coordinates  of  point  C^  with  respect  to  the  system 
^i^i^i^i  can  be  used  to  determine  the  necessary  joint 
displacements  by  inverse  kinematics,  which  is  described  in 
detail  in  Chapter  2.5.1.   It  is  noted  that  there  are  four 
possible  sets  of  solutions  for  a  given  location  and 
orientation  of  the  hand.   Each  set  of  solutions  corresponds 
to  a  specific  configuration  of  branches  of  the  subchains. 
Calculation  of  Jacobian  and  error  analyses  should  be 
performed  in  the  same  branch. 

In  Fig.  5.1,  the  position  vectors  ^A^,  °B^   and  unit 
vectors  °z^^   and  °z-^^   with  respect  to  the  global  coordinate 
system  OXYZ  can  be  calculated  respectively  by  coordinate 
transformation,  and  can  be  expressed  as  follows: 

°hi    =  T^Ai  (5^7) 

°Ii  =  TiBi  (5.8) 

°^i  =  Tj_z^j_  (5_9) 

°2bi  =  Tj_2i3j_  (5.10) 

5.3   Reciprocal  Screws 
A  screw  is  defined  by  Ball  [54]  as  a  straight  line  with 
which  a  definite  linear  magnitude  termed  the  pitch  is 
associated.   If  (l,  M,  N;  P,  q,  r)  are  the  Plucker 
coordinates,  as  shown  in  Fig.  5.2,  of  the  screw  axis,  (L,  M, 
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Figure    5.2      Pliicker    line   coordinates 
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N)  are  the  direction  ratios  of  the  line  and  (P,  Q,  R)  are 
the  X,  y  and  z  components  of  the  moment  of  the  line  about 
the  origin,  then  we  can  express  the  screw  coordinates  as 
(S  ;  Sq)  where 

S  =  Li  +  Mi  +  Nk  (5.11) 

§0  =  Pi  +  Qi  +  Rk  (5.12) 

and 

L  =  X2  -  XI 
M  =  Y2  -  Yi 
N  =  Z2  -  Zi 
P  =  y^N  -  Z3_M 
Q  =  -x^N  +  z^L 
R  =  x^M  -  y^L 

Figure  5.3  shows  a  rigid  body  which  is  constrained  to 
move  on  a  screw  $2  =  (S2;  Sq2  )  •   A  wrench  (f]_;  C^ )  of 
intensity  f^  is  applied  to  the  body  on  a  screw  $_]_  =  (S^^; 
Sqi)  and  it  produces  a  twist  (^2;  V2 )  of  amplitude  0^2  on 
the  screw  $2-   Thus  the  moment  of  the  force  f^  about  the 
point  A  is  sli2§l12   ^  ^  1 '  ^^^   the  virtual  worlc  produced  by  the 
wrench  can  be  expressed  as  follow: 

U  =  f -|_  •  V2  +  Ci  •  ^2  -  ^123:12  X  il  •  iii2  (5.13) 


154 


V2  =  hr)OJ2 


■ai2ai2  X  f  1  Ci  =  h^fi 


Figure    5.3      A  wrench   on   a   screw 
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substituting  fi  =  f^si,  Ci  =  hif^Si,  ^2   =    -2S2  and 
V2  =  h2a)2S2  into  Eq.  (5.13),  the  virtual  work  produced  by 
the  wrench  can  thus  be  expressed  as 

U  =  f3_W2  {(hi  +  h2)cosai2  -  ai2sinai2}  (5.14) 

If  the  pitches  hi  and  h2 ,  the  twist  angle  ai2,  and  mutual 
perpendicular  distance  ai2  between  the  axes  S^  and  S2  of  the 
two  screws  are  chosen  such  that 


(h 


1  +  h2)cosa]_2  -  ai2sina3_2  =  0  (5.15 


then  the  wrench  cannot  produce  motion  on  the  screw  $2  no 
matter  how  large  is  the  intensity  f^.   The  screws  $1  and  $2 
are  then  said  to  be  reciprocal.   It  is  noted  that  Eq.  (5.15) 
is  symmetrical,  and  a  wrench  on  the  screw  $2  cannot  produce 
motion  on  the  screw  $-,. 

Hunt  [49]  shows  that,  when  the  line  of  action  of  a 
force  passes  through  an  axis  of  an  revolute  pair,  the  force 
does  not  affect  the  rotation  around  the  revolute  pair 
because  it  cannot  exert  any  moment  about  it.   Reciprocity 
between  a  force  F  and  an  angular  velocity  o)  about  an 
revolute  pair  axis  means  that  when  a  body  is  attached  to  a 
base  through  a  single  revolute  pair  about  which  it  can  turn 
at  an  angular  velocity  u   at  any  instant,  a  force  F  is 
reciprocal  to  u  when  its  contribution  to  the  rate  of  working 
is  zero.   For  the  prismatic  pair,  when  the  line  of  action  of 
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a  force  is  perpendicular  to  the  direction  of  the  prismatic 
pair,  there  is  no  contribution  by  this  force  to  the  rate  of 
working.   Also,  an  revolute  pair  perpendicular  to  the 
direction  of  a  couple  also  satisfies  the  condition  of 
reciprocity.   All  couples,  no  matter  how  they  are  oriented, 
are  reciprocal  to  a  pure  translation  in  a  direction  parallel 
to  a  prismatic  pair.   Therefore,  if  a  body  is  constrained  to 
move  about  an  ISA  (Instantaneous  Screw  Axis),  C,  a  wrench 
acting  on  a  screw  c '  can  contribute  nothing  to  the  rate  at 
which  work  is  being  done  on  the  body.   In  such  a 
circumstance  c  and  ;'  are  said  to  be  reciprocal  screws. 

The  necessary  and  sufficient  condition  for  a  pair  of 
screws,  $.1  =  S]_  +  eSq^  and  $.2  ~  ^2  +  ^^02 '  ^°  ^^  reciprocal 
can  thus  be  expressed  as 

il  O  $2  =  Si  •  So2  +  S2  •  Sol  =  0  (5.16) 

where  the  symbol  O  denotes  the  reciprocal  product  of  a  pair 
of  screws. 

5. 4   Screws  of  the  Relative  Motion  of  the  Joints 
In  order  to  calculate  the  screws  representing  the 
relative  motion  of  the  joints,  we  would  like  to  have  each 
joint  expressed  with  respect  to  the  global  system  OXYZ. 
Let  *^ji(Sjj_,  Sqji)  denote  the  motion  screws  of  the 
joints  with  respect  to  the  OXYZ  system,  where  j  =  1,  2,..., 
6  denote  the  joints  and  i  =  1,  2  and  3  denote  the  subchain. 
Thus,  representations  of  the  screws  are 
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Cylindric  joint  A^    S^^  =  ^^lilS^i,  ^A^  x  S^^) 

i2i  =  V2i(0,  Sii) 
Revolute  joint  B^      $3^  =  '^2ii§.3ir    °B^   x  83^) 
Spherical  joint  C^    $4^  =  ^^4i(i,  oc^  x  i) 

isi  =  ^5i(i.  °Ci  X  i) 

i6i  =  ^Si^Kr     °Ci  X  k) 

where  Si^  =  Oz^^  and  S^i   =   °Zbi. 

Since  we  deal  with  instantaneous  kinematics,  the 
spherical  joint  Cj_  may  be  considered  as  a  combination  of 
three  revolute  joints  whose  concurrent  axes  are  parallel  to 
the  axes  of  the  OXYZ  system. 

Mohamed  and  Duffy  [46]  used  orthogonal  screws  to  study 
the  instantaneous  kinematics  of  the  end-effector  platform  of 
fully  parallel  robot  type  devices.   They  demonstrated  that 
for  any  parallel  device  the  twist  representing  the 
instantaneous  motion  of  the  end-effector  platform  is  equal 
to  the  sum  of  its  partial  twists.   A  partial  twist  is 
defined  as  the  twist  representing  the  instantaneous  motion 
of  the  end-effector  when  all  actuators  other  than  the  input 
actuator  are  locked. 

We  can  find  the  reciprocal  screws,  ^$;i^j_  and  ^i2i, 
reciprocal  to  all  other  screws  in  subchain  i  but  $1^   and 
$2i,  respectively.   As  shown  in  Fig.  5.4,  the  reciprocal 
screw  ^$1^   passes  through  the  center  of  spherical  joint  Cj_, 
intersects  the  axis  of  revolute  joint  Bj_  and  also  lies  on 
the  plane  P  which  is  perpendicular  to  the  axis  of  cylindric 
joint  A^.      In  Fig.  5.5,  the  reciprocal  screw  ^$2i  Passes 
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Figure  5.4   Reciprocal  screw  ^S.^  reciprocal  to  all  other 
screws  in  subchain  i  but  $i^ 
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Zai(Sii) 


Figure  5.5   Reciprocal  screw  ^$2j_  reciprocal  to  all  other 
screws  in  subchain  i  but  $2j_ 


160 
through  the  center  of  spherical  joint  Cj_  and  intersects  both 
the  axes  of  joints  Aj_  and  Bj_.   A  numerical  example  is  given 
to  illustrate  how  to  obtain  such  reciprocal  screws  as 
follow: 

Numerical  example.   With  the  base  arrangement  of  the 
manipulator  shown  in  Fig.  3.37  and  the  dimensions  of  the 
first  subchain  given  as  follows: 

a3_  =  3,  bi  =  2,  s^i  =  1,  h  =  1,  a^i  =  -90°  and  °Ci  = 
[4.000,  0.000,  2.732]T, 

one  set  of  the  four  possible  solutions  can  be  obtained  as 
d]^  =  1,  Q^i   =   0°    and  ©]-,]_  =  -60°  (see  Section  2.5.1). 
Therefore,  the  position  vectors  of  joints  A]_  and  B2_  with 
respect  to  the  global  coordinate  system  OXYZ  can  be 
calculated  as 


0.000 
■1.000 
1.000 


and  °Bi  = 


3.000 
■1.000 
1.000 


Therefore,  the  motion  screws  of  the  joints  with  respect  to 
the  global  coordinate  system  OXYZ  system  can  be  expressed  as 


$11  =  (0,  0,  1 


^21 


(0,  0,  0 


$31  =  (0,  1,  0 
$41  =  (1,  0,  0 


^51 


(0,  1 


$61  =  (0,  0,  1 


-1, 

0, 

0) 

0, 

0, 

1) 

-1, 

0, 

3) 

0, 

2.732, 

0) 

2.732, 

0, 

4) 

0, 

-4, 

0) 
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In  order   to   find   ^$11,    which   is   reciprocal   to  all   other 
screws    in   first   subchain  but    $xi,    the   following  equations 
must   be   satisfied: 

L2lPrl    +   M2lQrl    +   NsiR^-i    +   L^iP2l    +   M^lQzi    +   NrlR21    =    0 

(5.17) 
L3lPrl   +  M31QJ.1   +  N31RJ.1   +   LJ.1P31   +  MriQsi   +  NJ-1R31   =   0 

(5.18) 
L4lPrl   +  M41QJ.1   +  N41RJ-1   +   LJ.1P41   +  MriQ4i   +  NriR4i    =   0 

(5.19) 
Lsi^rl    +   MsiQ^i    +    NsiRj-i    +    L^iPsi    +   M^iQsi    +   N^iRsi    =    0 

(5.20) 
LeiPrl   +  ^eiQrl   +  NgiRri   +  LriPei   +  Mj-iQei   +  Nj-iRei   =   0 

(5.21) 

Therefore,  ^$]^]_  is  obtained  by  selecting  the  ratio  Rri/Mj-i  = 
4  and  solving  Eqs.  (5.17)  -  (5.21)  simultaneously,  which 
yields 

^$11  =  (0,  1,  0;  -2.732,  0,  4) 

Similarly,  ^$21  can  be  obtained  by  selecting  the  ratio 
^rl/^rl  =  4  ^^'^   solving  the  Eqs.  (5.18)  -(5.22) 
simultaneously,  which  yields 

^$21  =  (4,  1,  6.928;  -2.732,  -16.784,  4) 
where 

LllPrl  +  MiiQ^i  +  NiiR^l  +  L^iPii  +  M^iQii    +   N^iRii  =  0 

(5.22) 
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Similarly,  the  reciprocal  screws  ^$.ij_  and  -^$.21/ 
reciprocal  to  all  other  screws  in  subchain  i  (i  =  2  and  3) 
but  S_2_i  and  $21  ^  respectively,  can  be  found  as  the  positions 
and  orientations  of  joint  Cj_  are  given  and  therefore  are  not 
listed  here. 

It  is  noted  that  a  force  dose  not  affect  the  rotation 
around  a  revolute  joint  when  its  line  of  action  is  parallel 
to  or  along  the  axis  of  revolute  joint.   This  is  also  the 
reciprocity  condition. 

5. 5   Jacobian  Matrix 
Let  aj$_  represent  the  motion  screw  of  the  platform  with 
respect  to  the  global  system  OXYZ,  which  can  be  expressed  as 


6    3 
aj$  =   E    S   aj.^$.j_  (5.23) 

j=l  i=l 


Taking  reciprocal  products  with  reciprocal  screws  ^$.ii  and 
^l.2i  °f  ^^-  (5.23)  respectively  yields 

M$  o  ^$ii  =  0..^^$^^  o  ^$]_i  (5.24) 

and 

^1   O  ^i2i  =  ^2ii2i  O  ^i2i  (5.25) 

where  the  symbol  O  denotes  the  reciprocal  product  of  a  pair 
of  screws  and  i  =  1,  2  and  3.   Thus,  we  can  obtain  the 
following  equation: 
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-11' 


^il2^ 


±22 

^ii3^ 


^i23^ 


^[$]: 


iiio^'iii 

0 
0 
0 
0 
0 


0  0  0 

0  0  0 

^  i220^i22      0 
0  0      $i30^$3_3 

0  0  0    $230^$ 


[A]lo[$]    =    [B][lo^] 


"11 
"21 
^12 
"22 
"13 
"23 
(5.26) 

(5.27) 


where  the  components  of  [co^]  =  ('^n,    ^21,  w-j^2f  ^^22'  "13' 
"23  ^"^  are  the  intensities  of  the  motion  screws  of  the 
actuators,  and  for  the  linear  actuators  of  the  A^  joints, 

"21  ~   '^21'  "^22  =  "^22  ^^^   "23  ~  '^23- 

If  [A]  is  nonsingular,  we  can  write 


^[$]    =    [A]--L[B][co     ]    =    [JJLujg] 


(5.28) 


where  [J]  =  [A]"1[B]  may  be  called  a  Jacobian  matrix. 


5.6  Mechanical  Error  Analysis  of  the  Platform 
The  term  of  mechanical  error  defined  here  means  the 
minor  movements  of  the  platform  due  to  the  inaccuracies  in 
displacements  (rotation  and  translation)  of  the  actuators 
for  a  certain  specified  position  and  orientation  of  the 
platform.   Let  the  errors  of  the  displacements  of  the 
actuators,  [66^],  be  expressed  as 
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[60a]  =  [c^alSt,  (5.29) 

where  6t  denotes  a  very  short  period  of  time. 
Then  we  have 

(5.30) 
or 

6e[$]  =  [J][6ea]  (5.31) 

where  59  denotes  the  minor  angular  displacement  of  the 
platform  about  its  axis  due  to  the  error  input,  60^,  of  the 
actuators. 

The  movement  of  the  platform  is  generally  specified  by 
the  linear  displacement  of  the  center,  H,  and  the  angular 
displacements  of  the  hand  coordinate  system  embedded  in  the 
platform  about  the  axes  of  the  global  coordinate  system 
OXYZ.   In  order  to  calculate  the  components  of  the  minor 
movements  of  the  platform,  the  motion  screws  of  the  platform 
may  be  expressed  as 

aj$  =  u.[S  +  Sq]  =  aj[s  +  e(r  x  S  +  hS)  ]  (5.32) 

where  r  is  the  global  position  vector  of  an  arbitrary  point 
on  the  axis  of  the  motion  screw  of  the  platform,  e  denotes 
the  dual  part  of  a  vector  and  h  is  the  pitch;  this  screw  is 
shown  in  Fig.  5.6. 
Now ,  we  have 

(5.33) 
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Figure  5.6   Screw  representing  the  motion  of  the  platform 
with  respect  to  the  global  system  OXYZ 


and 


hS 
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(5.34) 


Since  r  =  H  +  rpj,  we  can  have  the  following  equations: 


(H  +  r„)  X  S 


(5.35: 


r^  X  S  +  hS  =  Sq  -  H  X  S  (5.36; 

The  velocity  of  the  center  H  of  the  platform  can  be 
obtained  as 

vjj  =  (^(r^  X  S  +  hS)  (5.37; 


Vf^  =  La(SQ  -  H  X  S) 
Then  the  linear  displacement  of  H  can  be  obtained  as 
Sdfj  =  69 (Sq  -  H  X  S) 


(5.38) 


(5.39) 


As  we  consider  differential  motions,  let  us  define  the 
rotation  matrix  of  a  small  rotation  angle  66  about  unit 
vector  S.   For  small  angles,  sin66  =  66,  cos69  =  1  and  V69 
=  cos66  -1=0.   Thus,  we  can  have  the  rotation  matrix 
with  small  66  as 


R[69,  s; 


S^^V66+C6e 


s^SyVee-s^see  SxS2V6e+SyS66  o 


SyS2V66-SxS6e   0 


Sj^SyV69+S2S69   Sy2v66+C69 


S„S^V66-S,,S69   S,,S-V69+SvS66   S-^V6e+C66 


'x'-'z 


0 


(continued) 
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1 

-s^se 

SySe 

c 

s^se 

1 

-s^se 

0 

SySe 

s^se 

1 

0 

0 

0 

0 

1 

(5.40) 


Dividing  the  small  rotation  angles,  69,  about  S  into  three 


components  60. 


69, 


and  602  about  the  axes  of  the  global 


system  OXYZ,  the  rotation  matrix  can  be  expressed  as 


Rot  (69, 


Rot(69y,  Y)  Rot (602 


1    0 

0 

0 

1 

0 

60y 

0 

1 

-602 

0 

0 

0    1 

-69^ 

0 

0 

1 

0 

0 

602 

1 

0 

0 

0   60^ 

1 

0 

-69^ 

0 

1 

0 

0 

0 

1 

0 

0    0 

0 

1 

0 

0 

0 

1 

0 

0 

0 

1 

1 

-602 

60Y 

0 

60Z 

1 

-60X 

0 

-66^ 

S0X 

1 

0 

(l 

0 

0 

0 

1 

(5.41) 


where  60^,  60^  and  602  are  all  small  angles.   We  therefore 
simplify  by  neglecting  the  second  and  third  order  terms. 
Comparing  Eqs.  (5.40)  and  (5.41),  we  obtain 


60, 


S^60 


60y   =   Sy69 


(5.42) 
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It  is  noted  that  a  differential  rotation  69  about  an 
arbitrary  unit  vector  S  is  equivalent  to  three 
differential  rotations,  StQ^,    5©y  and  Se^ ,  about  the 
X,  Y  and  Z  axes.   Finally,  the  error  movement  of  the 
platform  may  be  expressed  as  a  vector  as  follow: 


69S 


5dr 


S 

H  X  S 


59 


(5.43 


The  range  of  uncertainty  of  the  position  of  any  point 
in  the  end-effector  body,  say,  the  point  H,  is  shown  in 
Fig.  5.7.   Such  uncertainty  in  space  can  be  approximated  by 
a  small  parallelepiped,  whose  three  edges  are  6h,  p6©  and 
5d.   Here,  5h  is  the  axial  position  error,  p  is  the  distance 
of  point  H  from  the  error  screw  axis  $^,  6©  is  the  angular 
error  range  and  5p  is  due  to  the  uncertainty  of  position  of 
the  screw  axis. 


5 . 7   Summary 
The  mechanical  error  analysis  of  a  six  degree-of- 
freedom  parallel  manipulator  has  been  studied  in  this 
chapter.   Matrix  transformations,  widely  used  in  spatial 
mechanisms,  are  applied.   The  screw  theory,  as  applied  to 
determine  the  instantaneous  kinematics  of  fully  parallel 
manipulators,  is  utilized.   Numerical  example  is  presented 
to  show  how  to  determine  the  reciprocal  screws  in  each 
subchain.   Velocities  and  small  displacements  of  the  joints 
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Figure  5.7  Range  of  uncertainty  of  the  position  of  point  H 
on  the  end-effector 
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as  well  as  the  region  of  uncertainty  of  hand  position  due  to 
actuator  errors  are  described. 

The  interferences  between  links,  which  affect  the 
working  space  and  are  related  to  the  mechanical  error  of 
the  hand,  are  not  considered  in  this  chapter.   The  effect  of 
clearances  in  the  joints  and  tolerances  on  link  lengths  and 
the  resulting  uncertainty  of  the  hand  position  in  parallel 
manipulators  are  not  considered  in  this  chapter  either. 
These  are  some  of  the  subjects  recommended  for  further  study. 


CHAPTER  6 
CONCLUSIONS  AND  RECOMMENDATIONS  FOR  FURTHER  RESEARCH 


6 . 1   Conclusions 

An  industrial  robot  is  defined  by  the  U.S.  Robot 
Industries  Association  (RIA)  as  a  "reprogrammable, 
multifunctional  manipulator  designed  to  move  material, 
parts,  tools,  or  specialized  devices  through  variable 
programmed  motions  for  the  performance  of  a  variety  of 
tasks".   In  the  early  development  of  industrial  robots,  they 
operated  in  a  fixed  sequence  and  could  repeat  a  sequence  of 
operations  once  they  have  been  programmed.   Later,  the 
robots  were  equipped  with  sensory  devices  that  allowed  them 
to  act  in  a  not-completely  defined  environment.   Now  some 
industrial  robots  have  the  intelligence  to  allow  them  to 
make  decisions. 

It  has  been  well  recognized  that,  by  using  multi- 
degree-of-f reedom  robot  manipulators  with  multiple  actuators 
and  automatic  control  systems,  we  can  achieve  the  goal  of 
improving  efficiency,  accuracy,  reliability  and  reducing 
energy  consumptions  and  cost  of  production  in  a  flexible 
manufacturing  system. 

Robot  applications  are  continuously  widening,  their 
functions  are  becoming  more  and  more  complicated  and  the 
optimal  designs  are  not  yet  established.   Therefore,  some 
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basic  parameters  of  robots  should  be  considered  before  the 
applications  to  robotics,  and  they  are  listed  as  follows: 

1.  Mobility  (degrees  of  freedom) 

2.  Workspace  (volume,  shape  and  degrees  of 
redundancy) 

3.  Agility  (effective  speeds  of  execution  of 
prescribed  motions) 

4.  Positioning  (accuracy  and  repeatability) 

5.  Dynamics  behavior  (structural  stiffness,  masses, 
payload,  damping  coefficients  and  natural 
frequencies) 

6.  Economics  (cost,  reliability,  maintainability, 
etc.  ) 

In  recent  years,  there  has  been  considerable  increase 
in  research  in  the  area  of  robotics  and  multi-degree-of- 
freedom  programmable  automation  devices.   Almost  all  the 
industrial  robots  in  use  now  are  open-loop  serial-link 
manipulators  with  up  to  six  degrees  of  freedom.   Research  in 
the  field  of  parallel  manipulators  is  still  in  the  infancy 
of  development.   Therefore,  the  aim  of  this  study  is  to 
investigate  and  develop  the  theoretical  background  in  the 
kinematics  of  parallel  robots.   One  of  these  kinds  of 
manipulators  has  been  shown  in  Fig.  3.1. 

The  special  feature  of  the  proposed  parallel 
manipulator  is  that  the  novel  geometry  of  a  two-degree-of - 
freedom  self-actuated  joint  which  combines  a  rotary  actuator 
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and  a  linear  actuator,  is  introduced.   It  imparts  cylindric, 
two-degree-of-f reedom,  combined  rotational  and  translational 
relative  motion  to  the  link  with  respect  to  ground.   The 
distinct  advantage  of  using  this  kind  of  actuator,  called  R- 
L  (Rotary-Linear)  actuator,  is  that  the  inertias  of  the 
rotary  and  linear  actuators  are  independent  of  each  other. 
In  other  words,  the  inertia  of  the  rotary  actuator  is  not 
seen  by  the  linear  actuator  and  vice  versa.   Furthermore,  in 
case  of  parallel  manipulators,  all  such  R-L  actuators  can  be 
ground-mounted.   Thus,  the  linkage  itself  can  be  made 
lighter,  and  better  dynamic  performance  can  be  achieved.   It 
is  noted  that  one  of  the  attractive  utilizations  of  the  R-L 
actuator  is  that  they  can  also  be  used  in  the  military. 
Since  the  actuators  and  their  microprocessors  are  the  most 
sensitive  parts  of  manipulators,  they  can  be  shielded  from 
external  hazards  as  shown  in  Fig.  6.1.   Therefore,  only  the 
bare  moving  links  with  unpowered  passive  joints  are  exposed 
and  they  can  be  quickly  and  easily  replaced  once  they  suffer 
environmental  or  battle  damage.   Another  attractive 
utilization,  as  shown  in  Fig.  6.2,  is  that  the  manipulator 
can  be  in  an  overhead,  upside-down  position  for  high- 
precision  micro-manipulation. 

The  use  of  ground-mounted  R-L  actuators  in  conjunction 
with  a  parallel  manipulator  configuration  promises  to 
provide  some  unique  features  which  can  be  expected  as 
follows: 
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Figure  6.1   Shielded  R-L  actuators 
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Figure  6.2   Overhead  Micro-manipulator 
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1.  increased  pay load  capacities  with  ground-mounted 
actuators 

2.  increased  positioning  accuracy  supported  by  the 
parallel  subchains  (legs) 

3.  increased  speed  with  lighter  construction 

4.  better  dynamic  performance 

5 .  greater  economy  in  energy  consumption  and  reduced 
first  cost 

6.  reduced  computation  time  with  parallel  processing 

7.  restricted  workspace 

8.  increased  link  interference 

where  items  1  to  6  are  advantages,  7  and  8  are 
disadvantages . 

In  this  research,  the  type  synthesis  and  inverse 
kinematics  of  some  possible  subchains  with  six  degrees  of 
freedom  are  covered.   Workspace  analysis  of  the  parallel, 
platform- type  manipulator  is  presented,  by  determining  the 
shapes  of  the  subworkspace  and  the  boundaries  of  the 
subworkspace.   The  root  regions  in  the  subworkspace  is  also 
investigated.   The  workspace  of  the  manipulator  is  then  the 
common  reachable  region  of  the  three  subworkspaces 
determined  by  the  corresponding  subchain.   In  order  to  study 
the  positioning  error  of  the  hand  (or  end  effector)  of  the 
manipulator,  the  theory  of  screws  is  applied  to  determine 
the  instantaneous  kinematics  of  the  manipulator.   The  hand 
position  errors  due  to  linear  and  angular  inaccuracies  in 
the  motions  of  the  actuated  joints  are  prescribed. 
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6 . 2   Recommendations  for  Further  Research 

One  of  the  major  difficulties  in  parallel  manipulators 
is  the  problem  of  link  interference.   Once  the  link 
interference  problem  can  be  solved,  the  generalized 
workspace  can  be  found  meaningfully. 

It  is  recommended  to  simulate  the  motions  of  parallel 
manipulators  by  computer  graphics,  since  it  will  facilitate 
understanding  the  geometry  of  the  manipulators. 

This  study  is  concerned  only  with  a  kinematic 
viewpoint.   For  the  practical  application  of  these  types  of 
manipulators,  studies  of  statics  and  dynamics  should  follow. 

It  is  hoped  that  the  results  of  this  work  will 
contribute  towards  a  basic  understanding  of  the  limitations 
as  well  as  the  potential  usefulness  of  parallel,  platform- 
type  manipulators  with  ground-mounted  actuators. 


APPENDIX  A 
ALTERNATIVE  METHOD  OF  FINDING  THE  COORDINATES  OF  JOINT  C 


A. 1   Subchain  (R-L)-R-S 
By  using  the  notations  as  shown  in  Fig.  A.l  and  the 
method  presented  in  [44],  we  can  obtain  the  coordinates  of 
joint  C  with  respect  to  the  local  coordinate  system  as 


R  =  SiSi  +  ai2ai2 


SttSt  +  ao^a 


'22^2 


232:23 


(A.l) 


where  S^^  is  the  translation  along  the  S^^  axis,  S22  is  the 
offset  along  the  S2  axis,  and  a]_2  and  323  are  the 
perpendicular  distances  between  successive  joint  axes. 

We  can  rewrite  Eq.  (A.l)  by  using  the  Table  A.l  (set  1 
of  direction  cosines  -  spatial  heptagon)  as  follows: 
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where  U21  =  S2C2^2  ^^^   ^21  ~  ^2^12- 
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Si 


Figure   A.l      Subchain    (R-L)-R-S 
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Table  A.l   Direction  cosines  -  spatial  heptagon  (set  i; 
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Therefore,  the  coordinates  of  joint  C  with  respect  to  the 
local  coordinate  system  can  be  expressed  as  follows: 

Cx  =  ai2Ci  +  S22S12S1  +  a23(ciC2  -  S3_S2Ci2)  (A. 3) 
Cy  =  ai2Si  -  S22S12C1  +  a23{siC2  +  C1S2C12)  (A. 4) 
Cz  =  Si  +  S22C12  +  ^2332312  (A. 5) 

The  above  expression  are  the  same  as  those  in  Eq.  (2.5) 
except  for  different  notation  for  elements  of  the  subchain. 


A. 2   Subchain  (R-L)-P-S 
As  shown  in  Fig.  A. 2,  the  coordinates  of  joint  C  with 
respect  to  the  local  coordinate  system  can  be  obtained 
similarly  as 
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Figure   A. 2      Subchain    (R-L)-P-S 


SlSi  +  ai2ai2  +  SsSo  +  a23a23 
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(A. 6) 


where  Si    and  S2  are  the  translation  along  the  S]_  and  S2 
axes,  respectively,  and  a]_2  and  a23  are  the  perpendicular 
distances  between  successive  joint  axes. 

We  can  rewrite  Eq.  (A. 5)  by  using  the  Table  A.l  (set  1 
of  direction  cosines  -  spatial  heptagon)  as  follows: 
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where  U2X  =  S2C]_2  and  U21  =  S2S]_2' 

Therefore,  the  coordinates  of  joint  C  with  respect  to  the 
local  coordinate  system  can  be  expressed  as  follows: 


^x  =  ^12^1  +  S2S12S1  +  a23Ci 
Cy  =  ai2Si  -  S2S12C1  +  a23Si 
Cz  =  Si  +  S2C12 


(A. 8) 

(A. 9) 

(A. 10) 


The  above  expression  are  the  same  as  those  in  Eq.  (2.13 
except  for  different  notations  for  the  elements  of  the 

subchain. 


APPENDIX  B 
EQUATION  OF  A  GENERAL  FORM  OF  TORUS 


If  the  translation  d^  along  the  z  axis  of  the  local 
fixed  coordinate  system  is  disregarded  in  Eq.  (2.5),  (see 
Fig.  2.11),  we  can  obtain  the  following  equations: 

Cx  =  C9a(bce>3  +  a)  -  se^(bsebCab  -  SbSa^)  (B.l) 
Cy  =  sea(bceb  +  a)  +  C9a(bsebCab  -  SbSab)  (B.2) 
C2  =  bse^Sab  +  s^Cab  (B.3) 

Squaring  and  adding  Eqs.  (B.l)  -  (B.3)  yields 

^x^  +  Cy2  +  0^2  =  a2  +  b2  +  SJ32  +  2abceb  (B.4) 

Multiplying  Eq.  (B.4)  by  Saj^  yields 

Sab{(Cx2  +  0^2  +  0^2)  _  (a2  +  b2  +  3^2)}  =  2abcebSab 

(B.5) 
Multiplying  Eq.  (B.3)  by  2a  yields 

2a (C2  -  SbCa^)  =  2absebSab  (B.6) 

Finally,  squaring  and  adding  Eqs.  (B.5)  and  (B.6)  and  then 
rearranging  terms  yields  the  following  equation: 

183 


184 


{(Cx^  +  C„2  +0^2)  -  (a2  +  b2  +  Sb2)}2 


C^  -  s^Cab 

=  4a2{b2  -  ( )2]       (B.7) 

Saj3 

If  we  replace  Cj^,  Cy  and  C^  by  x,  y  and  z,  respectively,  sj-, 
by  s  and  a-^  by  a,  we  will  get  the  same  equation  as  shown  in 
Eq.  (3.1),  which  represents  the  general  form  of  torus  [51], 
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